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A platform  manipulator  is  a fully  in-parallel  device.  It  has  a linear  actuator  on 
each  of  its  six  legs.  The  legs  connect  a platform  to  a base  in  a certain  pattern  that  allows 
each  leg  to  sustain  a load  from  the  platform.  Design  of  leg  configurations  is  not  an  easy 
task.  Some  configurations  may  lead  a manipulator  into  an  uncontrollable  state  known  as  a 
singularity. 

The  proposed  ‘quality  index’  takes  a maximum  value  of  1 at  an  optimal 
configuration  that  is  shown  to  correspond  to  the  maximum  value  of  the  determinant  of  the 
six-by-six  Jacobian  matrix  of  the  manipulator.  When  the  manipulator  is  actuated  so  that 
the  platform  departs  from  this  optimal  configuration,  the  determinant  always  diminishes, 
and,  as  is  well  known,  it  becomes  zero  when  a special  configuration  is  reached  (the 
platform  then  gaining  one  or  more  uncontrollable  freedoms).  The  quality  index  A, 
0 < A < 1 , is  a constructive  measure  of  acceptable  design  proportions. 
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The  octahedral  manipulator,  which  has  equilateral  triangles  in  both  the  platform 
and  the  base,  turns  out  to  be  the  most  geometrically  stable  design  (strongest  design)  of  a 
manipulator.  However,  the  double-spherical  joints-and  there  are  six  of  them-are  the 
source  of  the  critical  practical  difficulties.  Kinematic  substitutions  can  circumvent  this 
problem,  but  most  often  there  is  no  reasonable  alternative  to  accepting  separations  of 
some  or  all  of  the  double-ball  joints.  Several  patterns  of  joint  separation  have  been 
suggested  in  the  paper  and  each  of  them  is  investigated  to  obtain  optimal  configuration. 
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CHAPTER  1 
INTRODUCTION 

The  Jacobian  Matrix  (at  a configuration  of  a fully  in-parallel  robotic  device  with 
one  linear  actuator  per  leg)  serves  two  distinct  purposes  that,  in  the  terminology  of  screw 
theory,  are  mutually  reciprocal. 

In  its  ordinary  form  as  a six-by-six  matrix  the  columns  of  which  are  the 
coordinates  of  the  actuator  screws  (ordinarily  the  normalized  leg-lines),  it  is  possible  to 
obtain  from  six  actuated  force  inputs  the  wrench  that  the  end-effector  platform  delivers. 
In  its  transposed  form  the  Jacobian  can  give  the  relative  linear  speeds  required  at  each 
linear  actuator  that  correspond  to  a given  twist  required  to  be  executed  by  the  platform. 
The  first  of  these  gives  the  (instantaneous)  solution  to  a problem  of  static  equilibrium;  the 
second,  the  solution  of  first-order  kinematic  compatibility.  When  the  Jacobian  is  singular 
(i.e.,  when  its  determinant  is  zero)  the  actuators  (i)  cannot  equilibrate  a general  wrench 
applied  to  the  platform  and  (ii)  cannot,  on  their  own,  prevent  a transitory  uncontrollable 
movement  of  the  platform.  This  latter  phenomenon  is  associated  with  the  platform’s  gain 
of  one  or  more  freedoms  when  all  actuators  are  locked. 

When  the  Jacobian  is  singular  the  corresponding  manipulator-configuration  is 
said  to  be  special.  There  are  other  manifestations  of  special  configurations,  for  instance, 
when  an  actuator  reaches  its  end  of  travel  (the  platform  then  ordinarily  loses  a freedom.) 
Such  situations  need  careful  attention  when  the  input  variable  is,  say  a rotation  at  the 
same  joint  that  serves  to  extend  or  shorten  a kinematically  equivalent  linear- 
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actuator  substitution  in  a ball-jointed  leg;  with  suitable  modifications  (and  some  care) 
such  structures  could  come  within  the  range  discussed  here. 

It  is  mentioned  in  passing  the  work  of  Cox  (1981)  and  Duffy  (1996),  both  of 
whom  cover  special  configurations  of  planar-motion  manipulators.  Merlet  and  Gosselin 
(1991),  amongst  others,  examine  the  special  configurations  of  a new  architecture  of  a six- 
degree-of-freedom  parallel  manipulator. 

Hunt  and  McAree  (1998)  go  into  considerable  detail  for  the  general  octahedral 
manipulator,  its  special  configurations  being  described  in  the  context  of  other  geometrical 
properties.  The  condensed  form  of  the  Jacobian  matrix  in  McAree  and  Daniel  (1996) 
may,  we  believe,  be  used  as  a basis  from  which  to  develop  the  argument  that  follows. 

From  the  practical  standpoint  and  in  the  absence  of  additional  control  means,  the 
manipulator  must  not  approach  “too  closely  to”  a special  configuration  and  the  question 
“how  close  is  too  close?  ” is  often  hard  to  answer. 

Here  the  problem  is  tackled  from  the  other  end.  Both  the  proportions  and  the 
configuration  of  that  octahedral  manipulator  that  gives  the  greatest  absolute  value  of  the 
determinant  of  the  Jacobian  J,  namely  |det7|^,  is  determined.  Because  at  any  other 

configuration  |det7|  takes  a lower  value,  a dimensionless  quality  index  defined  by 


Idetyl 


(1) 


at  every  reachable  configuration,  0 < A < 1 . 

Some  may  wonder  why  the  equation  (I)  is  adopted  as  an  index  of  quality  rather 
than  use  other  well-established  methods  (found  in  books  on  theory  of  matrices  and  linear 
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algebra)  that  lead,  via  norms,  or  diagonalization  and  singular  value  decomposition,  and  so 
forth,  to  properties  that  relate  to  ‘conditioning’. 

Such  methods  are  nearly  always  based  on  the  presumption  that  a column-vector, 
say,  of  a six-by-six  matrix  can  be  treated  as  a vector  in  91^.  However,  the  six  elements  in 
the  column  of  a typical  robot  Jacobian  are  the  normalized  coordinates  of  a screw  (almost 
always  of  zero  pitch,  i.e.,  a line);  in  a metrical  coordinate  frame  three  of  them  are 
dimensionless  and  three  have  dimension  [length],  such  a length  being  the  measure  of  the 
moment  about  a reference  point  of  a unit  force. 

The  column  is  made  up  of  two  distinct  vectors,  each  of  them  in  , except  in  two 
circumstances,  in  both  of  which  the  Jacobian  is  reduced  to  a three-by-three,  pure 
translational  velocity  in  any  direction,  or  pure  angular  velocity  about  any  axis  through  the 
origin.  In  general  there  is  no  way  of  unifying  the  dimensions  of  the  coordinates  of  a 
normalized  line.  For  the  legs  of  the  octahedral  manipulator  it  is  not  possible  to  remove 
all  the  length  dimensions  from  their  coordinates  because,  even  the  adoption  of  some 
artificial  length  unit  can  fail  due  to  the  fact  that  a moment  can  never  be  converted  to  a 
pure  force.  Moreover,  any  index  of  quality  derived  from  such  textbook  techniques  is 
likely  to  vary  according  to  the  coordinate  frame  in  which  the  Jacobian  is  formulated. 

I do  not  here  examine  the  circumstances  in  which  such  an  approach  may  produce 
meaningful  results;  rather  we  remain  on  what  we  know  is  safe  ground,  recognizing  first, 
that  the  determinant  of  a (square)  Jacobian  of  line  coordinates  (or  even  of  the  more 
general  screw  coordinates)  is  dependent  solely  on  the  configuration  in  91^  of  the  actuated 
axes  and  not  at  all  on  the  coordinate  frame  in  which  the  line  coordinates  are  determined; 


4 


and  second,  that  because  equation  (1)  is  a dimensionless  ratio,  our  quality  index  is  always 
independent  of  the  choice  of  units  of  length  measurement. 

For  the  planar-motion  manipulator  of  Figure  1 when  the  platform  triangle  is 

general,  its  sides  having  lengths  //,  I2,  and  I3,  Lee,  Duffy  and  Keler  (1996)  found  Idet  J| 


to  be  equal  to  -^(/i  +^2  +^3)-  When  the  platform  is  equilateral,  as  drawn,  |det  J|^ 


With  suitable  fixed  base-point  Ea,  Eb  and  Ec  placed  anywhere  on  the  sides  of  the 
larger  triangle  (shown  in  dotted  outline),  as  triangle  ABC  is  guided  away  from  its  central 
location  the  value  of  A (see  equation  (1))  always  diminishes. 

In  what  follows,  I make  a comparable  study  of  the  (spatial)  octahedral 
manipulator.  Having  determined  the  proportion  and  the  configuration  that  give  A = 1, 
then  1 examine  the  extent  to  which  A degrades  as  the  platform  displaces. 

Further,  1 extend  the  research  to  a 3-6  platform  device  which  has  three  double 
joints  on  a moving  platform  and  six  single  joints  on  the  base  and  6-6  platform  device 
which  has  six  single  joints  on  both  moving  and  base  platform. 

A quality  index  has  two  clear  meanings  so  far.  When  A,=0,  a platform  is  in 
singular  condition  and  when  A,=l,  it  is  in  its  optimal  configuration  to  sustain  loads. 
However,  when  X,  is  neither  zero  nor  one,  it  is  hard  to  say  exactly  how  much  one 
configuration  is  better  than  another.  One  can  not  say  that  a configuration  with  X=0.8  is 
twice  as  good  as  a configuration  with  X=0.4  without  further  analyses  on  the  matter.  But,  a 
quality  index  helps  to  design  platforms  by  setting  dimensions  that  give  best  quality  index 
value  i.e.  X=l.  Also,  it  gives  an  idea  of  certain  designs  that  must  be  prevented  as  they 
would  lead  to  zero  or  low  quality  indexes. 
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Figure  1 : Equilateral  triangular  platform  in  its  central  location,  planar  motion 


CHAPTER  2 

DETERMINATION  OF  Idet  j\  FOR  A 3-3  OCTAHEDRAL  MANIPULATOR 

I I m 


Figure  2 illustrates  the  plan  view  of  a 3-3  device  with  an  equilateral  triangular 
base  of  side  b,  and  an  equilateral  triangular  moving  platform  of  side  a.  The  moving 
platform  is  parallel  to  the  base  and  a distance  h from  it.  The  six  legs  EaA,  EbA,  EbB,  EcB, 
EcC,  and  EaC  have  ball-joints  at  their  ends  and  linear  actuators  to  vary  their  lengths. 


Figure  2 ; Octahedral  3-3  manipulator,  plan  view 
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It  is  required  to  determine  the  value  of  h which  yields  a maximum  absolute  value 
for  |detj| , the  determinant  of  the  line  coordinates  of  the  six  legs,  that  is  an  expression  for 

Idetyl  . 

I \m 

The  (x,  y,  z)  coordinates  of  the  points  A,  B,  C,  E^,  Eb  and  Ec  are  determined  with 
the  origin  O of  a fixed  coordinate  frame  placed  at  the  center  of  the  triangle  ABC,  and  then 
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The  coordinates  of  a line  joining  two  finite  points  with  coordinates  (x/,  yi,  zi)  and 
te.  yz,  Z2)  are  given  by  the  second-order  determinants  of  the  array 
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and  the  moment  of  the  line  segment  about  the  three  coordinate  axes  are 
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For  example,  the  coordinates  of  E^A  are  obtained  from 
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and  therefore, 
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The  coordinates  of  EbA  are,  similarly. 
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The  remaining  coordinates  are 
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Hence,  from  (6)  to  (1 1),  the  normalized  determinant  of  the  six  lines  (now  all 


reduced  to  unit  length)  is 
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Conveniently,  here,  the  normalization  divisor  is  the  same  for  each  leg,  namely  the 
leg  length,  / = EaA  = EbA  = EgB  = EcB  = EcC  = £,4C,  and  for  every  leg 


/ = Vz.^+M^+yV^  =J^(a^-ab  + b^+3h^). 


Expansion  of  (12)  and  inclusion  of  (13)  leads  to 


|dety|  = 


a^-ab  + b^  ,2.3 


4( 


■ + h^y 


Dividing  above  and  below  by  yields 

3Sa^b^ 


Idetyl  = 
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(14) 


(15) 


Differentiating  the  denominator  with  respect  to  h and  equating  to  zero  to  obtain  an 


optimal  value  yields 
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(16) 


which  is  now  substituted  in  (15)  to  give  the  expression  for  the  maximum  of  |det7| , 


namely 


Idetyl  = 
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Substituting  b=ya  into  (18)  and  dividing  above  and  below  by  y yields 

21a^ 
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(18) 


32 
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The  absolute  maximum  value  of  |det  j\^ , namely  |det  , is  obtained  by  taking 


the  derivative  of  (18)  with  respect  to  y which  yields 


^ 2^ 

1 =0, 

Y 

V ' 


whence  we  obtain  a further  condition,  namely 


(19) 


y = - = 2. 
a 


(20) 


This  octahedron  has,  therefore,  a maximum  quality-index  configuration  as  it  is 
shown  in  Figure  3,  and  the  distance  from  the  base  to  the  platform  is,  from  (16),  h=a. 
Now,  from  (18) 


1^  ,1  3V3  3 

dety  = a . 

I \om  A 


(21) 


The  volume  of  the  octahedron  of  Figure  3 is 


11 


and  when  b=2a  and  h=a. 


V =^^h{a  + by 
12 


V=^a'=|det7|  . 

^ I I am 


(22) 


(23) 


Now  the  inteqjretation  of  |det7|^^^  (21)  is  clear.  It  is  simply  the  volume  of  the 
particular  octahedron  with  moving  platform  sides  a,  base  sides  2a,  and  distance  between 
platform  and  base  a (Figure  3).  This  result  is  comparable  to  |det7|^^  for  the  planar- 


motion  equilateral  triangular  manipulator  case  for  which  |detyj^^  - —I  (see  Figure  1). 


The  quality  index  A = 


|dety| 


(equation  1)  can,  from  (14)  and  (17),  be  expressed 


in  the  form 


A = ' 


r u \ 


(24) 


1 + 


\ m J 


1 + 


\ j 


where  /i„,  is  obtained  from  (16).  A plot  of  A vs.  h/hm  is  shown  in  Figure  4,  and,  from  (24), 


A = 0 when  h = 0 or  h = °°. 
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Figure  3 : Octahedron  in  the  central  configuration  (highest  quality  index),  plan  view 
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Quality  Index  X 

Figure  4 ; How  quality  index  varies  with  distance  between  base  and  platform 


CHAPTER  3 

A GEOMETRICAL  INTERPRETATION  OF  det7 


It  can  be  shown  using  the  Grassmann-Cayley  algebra  (McMillan  1990,  White  and 
Whiteley  1983)  that,  for  a general  octahedron,  when  the  leg  lengths  are  not  normalized, 

deU*  ^[Eg  A C][E^  E^  C B][E^  Eg  B A] 

+ [Eg  E^  A B][E^  E^  C A][E^  Eg  B C].  (25) 

Each  bracket  is  simply  the  fourth  order  determinant  of  the  coordinates  of  four 
finite  points  written  homogeneously  as  (1,  x„  y„  z,).  The  six  points  in  (25)  are  the  vertices 
of  the  octahedron.  Each  bracket  is  six  times  the  volume  of  a tetrahedron  the  vertices  of 
which  are  the  four  points.  The  dimension  of  det  J*  is  (volume)^  ; our  previous  definition 
det  J requires  det  J*  to  be  normalized  with  respect  to  the  leg  lengths. 

Each  bracket  for  the  octahedron  of  Figure  2 (with  the  coordinates  tabulated  in  (2)) 


yields  the  same  absolute  value, 


s 


abh 


, and  so 


Idet  J * 


= 2 


abh 


3V3 


a^b^h\ 


(26) 


V J 

Consider  now  the  four-by-four  array  M of  the  homogeneous  coordinates  of  the 
vertices  of  a tetrahedron  formed  by  a pair  of  points  1 and  2 of  the  base  triangle  (i.e.,  any 
pair  of  Ea,  Eb  and  Ec)  for  which  z=-h  and  a pair  of  points  3 and  4 in  the  moving  platform 
(i.e.,  any  pair  of  A,  B and  C)  the  join  of  which  is  parallel  to  the  base  and  a distance  h from 
it.  M can  be  written  as 


14 


15 


1111 


yi  ^2  3^4 

0 0 -h  -h 


(27) 


When  the  moving  platform  translates  parallel  to  the  base  it  undergoes  a shearing 


motion  M— >M’  where 


1 

1 

1 

1 

X, 

X2 

X3  + X 

X4  +x 

3'i 

3^2 

3^3  + 3' 

3^4  +3’ 

0 

0 

- h 

-h 

The  determinant  of  M’  simplifies  to 


detM'=  -h 


1 


0 


)'2  yS  - 3^4 


(28) 


(29) 


which  is  independent  of  extent  of  the  shearing  that  is  given  by  x and  y.  The  result  can  be 
obtained  directly  from 

M’=TM  (30) 


where 


T = 


1 0 0 
0 1 0 
0 0 1 
0 0 0 


0 

— x/h 

- yl  h 

1 


(31) 


is  the  shear  transformation,  the  determinant  of  which  is  1.  Then 


det  M '=  det  T x det  M = det  M 


(32) 
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It  follows  that  each  of  the  fourth-order  determinants  in  (25)  is  invariant  with  the 
shear  action  and  hence  det7*  is  also  invariant. 


Now  we  can  compute  the  induced  six-by-six  shear  matrix  that  transforms  the 


coordinates  of  the  six  legs  by  counting  the  36  second-order  determinants  of  T (equation 


(31)),  namely 


1 

0 

- x!  h 

0 

0 

0" 

0 

1 

- yl  h 

0 

0 

0 

0 

0 

1 

0 

0 

0 

0 

0 

0 

1 

0 

0 

0 

0 

0 

0 

1 

0 

0 

0 

0 

xlh 

y/h 

1 

and  of  course  |det  | = 1 . 


(33) 


Evaluating  (25)  with  a rotation  9 about  the  vertical  Z-axis  yields 


[£,  E,  A C]=[£, 

[e,  E^  a b]=[£. 


and  then 


Ec  C b]=[Ec  Eg  B a] 


^ ■ a ^ a 
— sm  9 cos  6^ 

2 2 


abh. 


E^  C a]=[Ec  Eg  B C] 


1 


-—sm9--^cos9  abh, 
2 2 

y 


(34) 


(35) 


detJ’ 


COS0  . 

4 


(36) 


The  manipulator  is  at  a special  configuration  when  det/*  = 0.  Either  one  or 


more  brackets  (see  (25))  in  the  first  and  second  products  vanish  simultaneously,  or  the 
product  of  first  three  brackets  is  equal  and  opposite  in  sign  to  the  product  of  the  second 
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three  brackets.  This  latter  case  corresponds  to  a 90°  a pure  rotation  about  the  Z-axis  (see 
(34)  and  (35)). 

Only  when  the  four  points  of  a bracket  are  coplanar  is  that  bracket  zero.  Some  of 
the  special  configurations  described  by  Hunt  and  McAree  (1998)  correspond  to  two  sets 
of  four  vertices  of  an  octahedron  being  coplanar,  one  zero  bracket  being  in  the  first 
product  and  one  in  the  second.  However,  those  special  configurations  for  which  no  four 
vertices  are  coplanar  correspond  to  the  two  products  having  equal  absolute  magnitudes 
but  opposite  signs.  When  the  platform  of  Figure  2 is  rotated  through  +60°  about  the 
Z-axis  all  three  brackets  of  one  product  are  zero  (three  sets  of  four  coplanar  vertices),  but 
no  bracket  of  the  other  product  is  zero,  and  vice  versa  when  angle  rotated  is  -60°.  The 
configuration  is,  therefore,  not  special. 

I do  not  pursue  here  the  possibility  of  using  (25)  to  find  the  maximum  value  of 
|dety| , but  certainly  this  alternative  approach  must  yield  identical  results  for  our  quality 


index. 


CHAPTER  4 

FURTHER  DEPARTURES  FROM  THE  CENTRAL  CONFIGURATION 

I now  derive  an  expression  for  |det  J|  when  the  moving  platform  displaces  in  pure 
translation  in  the  xy-plane.  The  coordinates  for  the  center  of  the  moving  platform  are  now 
(x,y,0)  not  (0,0,0)  as  in  Figure  2,  z remaining  zero.  From  (4)  the  coordinates  for  each  of 
the  six  legs  can  be  expressed  in  the  form 

{l^+x  M^+y  Ni  Pi  Qi  - y.x  + x^y  (i=l,2, ...  6)  where  U,  M,-,  Nf,  Pi,  Qi,  and 
Ri  are  the  columns  of  (12)  and  Xj  andy,  (j=l,2,3)  are  the  coordinates  of  the  base  points  Ea, 
Eb  and  Ec.  For  example  the  coordinates  5,  after  a displacement  (x,y)  are 


a -b  a + b az 

+ x — — + y z ; 


az  ab  b b 
■ + — —x  + — y 


(37) 


2 2V3  ' ’ 2V3  2 2V3  ' 2V3"  ' 2‘ 

When  (12)  is  set  up  using  the  new  line  coordinates  the  result  is  surprisingly 
simple.  The  numerator  of  det  J is  invariant  with  translations  of  the  moving  platform  in  the 
xy  plane  i.e.  shearing  motions  (see  Chapter  3)  and 


|det  J\  = 


3y[2a^b 


3_3 


4 /,  1 2 1 2 1 4 /fi 


(38) 


where 
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19 


/.= 


^3  = 


h- 


^ a-b 
+ x 

[ 2 J 

2 

+ 

a + b ^ 

+ z^ 

( « V 
1 2 J 

(a -2b  ] 

""j 

2 

— + JC 
v2 


( b -2a  ^ 

+ 

J 

[ 2V5  '^J 

+ z‘ 


h = 


h = 


u V ^ 


■ + x 


+ 


a-2b  ^ 

TJT*^ 


+ z\ 


b — a 


■ + x 


V 


N,2 

fa  + b ] 

+ 

/ 

I2VI  '^] 

+ z^  (39) 


f b 

— + x 

2 


V (b-2a 


+ 


2V3 


■+>' 


+ z\ 


and,  from  (38)  and  (17),  the  quality  index  is  given  by 


A 


_ 8^^3(^Ja^  -ab  + b^)\^ 


91,  I,  I,  I,  I, 


(40) 


Figure  5 : Coplanar  translation  of  platform  from  central  location  : contours  of  quality 

index 
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Figure  5 shows  the  contours  of  quality  index  as  the  platform  of  the  octahedral 
manipulator  is  translated  away  from  the  central  location  parallel  to  the  base  plane  taking 
The  side  of  the  platform  is  chosen  as  a=  \ and,  from  (20),  the  base  side  b=2. 

The  contours  are  labeled  with  values  of  constant  quality  index.  When  x or  y is 
infinite,  A=0. 

The  contours  are  close  to  being  concentric  circles  of  various  radii.  Substituting 
X = r cos  0 and  y = r sin  6 in  (40)  together  with  a = \,b  = 2 and  z = 1 yields 

, ^ (41) 

+6r“’  +21r*  +(5O-2cos(60))r"  +84r^  +96r^  +64 

It  can  easily  be  shown  numerically  that  the  term  (5O-2cos(60))  / is  negligible 
over  the  range  0 < r < °o  since  the  upper  and  lower  bounds  for  A occurs  when 
cos60  = ±l  for  which 


A.. 


upper 


+ 6r'“  + 21r*  + 48r^  + 84r^  +96r"  + 64  ’ 


(42) 


^lower 


+ 6r'“  + 21r  V 52r"  + 84/-“  + 96r'  + 64 


(43) 


The  maximum  deviation  from  a circle  occurs  when  r = V2  , for  which 
A -A,  =0.00203. 

Figure  6 illustrates  how  the  quality  index  varies  as  the  platform  is  rotated  away 
from  its  central  location  about  a vertical  Z-axis  through  its  center,  the  legs  being  adjusted 
in  length  to  keep  the  platform  in  the  xy  plane.  The  octahedron  has  the  highest  quality 
index,  A = 1,  when  0 = 0°,  A = 0 when  9 = ±90°.  It  can,  moreover,  be  shown  that 
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platform  rotation  through  ±90°  about  any  axis  parallel  to  the  Z-axis  leads  to  a special 
configuration  with  A = 0 (see  Hunt  and  McAree,  1998).  Figure-7  illustrates  the 
corresponding  configuration  of  the  platform. 


Rotation  6 

Figure  6 : Rotation  of  platform  about  Z-axis 
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Figure  7 : A singularity  configuration  (Z  axis  rotation) 

Rotations  about  lines  in  the  xy-plane  are  linear  combinations  of  rotations  about  the 
X-  and  Y-axis  (see  Figures  8 and  9 for  the  rotation  component).  Figure- 10  shows  a 
singularity  configuration  of  the  platform  when  the  platform  rotates  60°  about  X-axis. 


Rotation  6 

Figure  8 : Rotation  of  platform  about  X-axis 


Quality  Index  A 
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Figure  10  : A singularity  configuration  (X  axis  rotation) 


CHAPTER  5 

DETERMINATION  OF  |det  FOR  A 3-6  PLATFORM  MANIPULATOR 

Figure  11  illustrates  the  plan  view  of  a 3-6  platform  with  a moving  equilateral 
triangle  of  side  a which  is  parallel  to  a hexagonal  base  with  three  pair  of  joints  Eaj,a2, 
Ebi,b2  and  £’c;,c2-  Each  pair  of  joints  is  separated  by  distance  fib  for  which  0<  P <l  and 

the  moving  platform  is  raised  to  distance  h.  Each  of  the  six  legs  EaiA,  Ea2A,  EbiB,  Eb2B, 
EciC  and  Ec2C  are  S-P-S  connector  chains. 


A 

/ \ 

/ \ 


Figure  1 1 : Spatial  3-6  platform  device  (plan  view) 
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Now  the  determinant  of  the  Plucker  coordinates  of  the  six  legs  is  used  to 
determine  a maximum  value  for  det  J.  First,  the  coordinates  of  the  points  A,  B,  C,  Eaj, 
Ea2,  Ebi,  Eb2,  Eci  and  Ec2  are  determined  referenced  to  the  origin  O located  at  the 
center  of  the  base  platform  as  illustrated. 


a a 


2 2^^3 


B 


a a 


2 2V3 


C 


0 — ^ h 


'Al 


b{l-P)  bOP-i) 


"81 


"Cl 


2 

2 

-El 

1.(2 -38)  0 

2 

2V3 

b{2P 

-1)  _ 1,  , 

0 


2V3 


'A2 


"82 


"C2 


Pb  bi2-3P)  ^ 

2 2V3 


b{l3-[)  b(3P-[) 


b{l-2l3) 


2V3 


2V3 


0 


(44) 


and  the  corresponding  line  coordinates  are 


S 


1 


a-b{l-  P) 
2 


^2  = 


^3  = 


a - pb 
Pb  — a 


a + b{\-3p)  , 

f ^ 9 

2V3 

a-b{2-3P) 

I — ^ 9 

2V3 

a-b{2-3P)  , 

2V3 


bh{3P-\)  bh{p-l)  ab{l-2P) 


2V3 

2 

2V3 

bh(2-3p) 

pbh 

ab{2P-l)' 

2V3 

2 

2V3 

bh{2-3P) 

Pbh 

ab{l-2P)' 

2V3  2 2V3 


(45) 


(46) 


2 


(47) 
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^4  = 


'b(l-l3)-a  a + b{i-3P)  , bhi3P-\)  bh{l-P)  ab{2P-l) 

h ; p — p — (48) 


2^^3 


2V3 


2^^3 


Ss  = 


'b{l-2P)  b-2a 

2 2V3 


/I  ; 


bh  Wz(l-2i3)  ab{l-2p) 


2V3 


2V3 


(49) 


^6  = 


'^>(2)3-1)  ^-2fl 

2 2V3 


h ; - 


bh  bh{2l3-l)  ab{2l3-l) 


2V3 


2V3 


(50) 


From  (45)  to  (50), 


a-b(l-/3) 

a - f3b 

Pb-a 

b{l-2P) 

M2)3-1) 

2 

2 

2 

2 

2 

2 

a+b(l-3/3) 

a-b(2-3P) 

a-b{2-3P) 

« + Ml-3)3) 

b — 2a 

b-2a 

2V3 

2V3 

2V3 

2V3 

2V3 

2V3 

h 

h 

h 

h 

h 

h 

bh{3P-l) 

bh(2-3p) 

bh{2-3P) 

bh(3P-\) 

bh 

bh 

2V3 

2V3 

2V3 

2S 

2V3 

2V3 

Wi(/3-l) 

pbh 

pbh 

bh(l  - P) 

^7/z(1-2)3) 

bh(2P-[) 

2 

2 

2 

2 

2 

2 

ab(l-2P) 

ab(2P-[) 

ab{\-2P) 

ab{2P-[) 

aMl-2/3) 

ab(2P-l) 

2V3 

2V3 

2V3 

2S 

2V3 

2V3 

(51) 


where  / = £'/\/A  = Ea2A  = £'5/5  = £378  = £c/C  = £c2C  tind  for  any  leg 


I = ^Jl^+M^  + N^  = -ab  + b^3/3^ -3/3  + l)  + 3h^)  (52) 


Expanding  (51)  yields 


dety  = 


8lV3a^^-Vz-'(2)3-l)-^ 

4(a^ -ab  + b"(3j3~ -3/3  + l)  + 3h-y 


(53) 
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It  is  clear  that  when  = — , the  platform  is  degenerated.  Each  pair  of  legs,  E^iA 

and  Ea2A,  EbiB  and  Eb2B,  and  EciC  and  Ec2C  are  col  linear  and  det  7=0. 

Differentiating  with  respect  to  h,  det  occurs  when 


h^J^(a^-ab  + b\3/3^ -3/3  + 1)) 


Substituting  (54)  into  (53)  yields 


det7_,  = 


27a^b^(2j3-iy 


32(a^  -ab  + b^(3j3^ -3/3  + 1))'^ 


Substituting  b = ya  into  (55)  and  dividing  above  and  below  by  /yields 


det7„,  = 


21a\2p-l)^ 


32 


1 1 


--  + (3/S'  -3j3  + l) 


(54) 


(55) 


(56) 


j y 

The  absolute  maximum  value  of  det  is  obtain  by  taking  the  derivative  of  (56) 
with  respect  to  / which  yields 


1 


I'y 


= 0 


(57) 


and 


/=-=2 

a 


(58) 


It  is  interesting  to  note  that  the  moving  and  base  platform  ratio  / which  is  required 
to  define  det  Jam  is  independent  to  a value  of  /3.  Further  from  (56)  when  / = 2 , 

3V3  , 

__  = a 


det  7 


4 


(59) 
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which  is  identical  to  the  result  for  the  octahedron  platform  device  with  moving  platform 
sides  a , base  sides  2a  and  height  a.  It  is  clear  that  det  Jam  is  not  dependent  to  the  value  of 

/3.  This  special  3-6  platform  with  h = (see  (54))  is  shown  in  the  optimal 

configuration  in  Figure  12. 


A 

/ \ 


Figure  12  : Spatial  3-6  platform  in  optimal  configuration 


CHAPTER  6 

DETERMINATION  OF  Idetyl  FOR  A 6-6  PLATFORM  MANIPULATOR 

I Im 


Figure  13  illustrates  the  plan  view  of  a 6-6  platform  device.  The  moving  platform 
joints  are  separated  by  aa  where  0 < a < 1 and  base  joints  are  also  separated  by  Pb  where 
0 < < 1 from  their  original  double  joints.  The  platform  is  raised  to  a distance  h.  Each  of 


the  six  legs  EaiAj,  EaiA2,  EbjB],  EB2B2,  EciCj  and  EC2C2  are  S-P-S  connector  chains. 


A 

/ \ 

/ \ 


Figure  13  : Spatial  6-6  platform  device  (plan  view) 
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The  coordinates  of  the  points  A/,  fi/,  C/.  ki,  B2,  C2,  E^i,  Eai,  Em,  Eb2,  Ea  and  Eci 
are  determined  with  O located  at  the  center  of  the  base  platform  to  determine  the  Plucker 
coordinates  of  the  six  legs. 
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(60) 


By  following  the  same  steps  (3)  through  (12),  all  the  leg  lengths,  which  are  the 
same  for  all  six,  and  the  determinant  of  Jacobian  matrix  of  six  legs  are, 


1 = 


-3a  + l)+ab{3ali-l)  + b^{3P^ -3P  + \)+3h^) 


(61) 


and 


dety  = 


SlSa'b^h\3al3  -2a-2P  + iy 

4{a\3a^-3a  + 1)  + ab{3a^  - 1)  + b\3P^-3P  + 1)  + 3/7^’ 


(62) 
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It  is  interesting  to  note  that  det  7 = 0 when  3afi -la-ip  + 1 = 0.  This 
relationship  always  yields  similar  base  and  moving  platform  and  some  of  these  cases  are 


have  finite  mobility  when  all  six  actuators  are  locked.  All  the  six  connector  legs  lie  on  a 
regulus  and  the  platform  has  three  degree  of  freedom  since  these  connector  lines  belong 
to  a three  system.  Such  mechanisms  belong  to  the  Bricard  class  which  have  full-cycle 
mobility.  The  plot  of  the  function  is  illustrated  by  Figure  14. 

Differentiating  (62)  with  respect  to  h,  det  J^,  occurs  when 


and  then  substituting  (63)  into  (62)  yields 


det  7 


21a^b\3ap-2a~2P  + iy 


(64) 


3 


32(a\3a-  -3a -i- 1)  + ab(3aP -l)  + b\3P^ -3^  + 1))^ 


Substituting  b = ya  into  (64)  and  dividing  above  and  below  by  y yields 


det  7 


21a\3a^-2a-2P  + \f 


(65) 


m 


32 


P 

Figure  14  : Plot  P ) = 3aP  -2a  -ip  +1=0  and  configurations  for  det  7 = 0 


The  absolute  maximum  value  of  det  J„,  can  be  determined  by  taking  the  derivative 


of  (65)  with  respect  to  / which  yields 


2 

Y 


3a  + l)+3aP  -1 


= 0 


(66) 


and  therefore 


b _-6a^  + 6a -2 
a 3aP  - 1 


(67) 


The  ratio  / is  now  dependent  to  the  values  of  both  a and  p.  Further  when  a = 0, 


the  result  is  the  same  as  3-6  platform  (/=  2)  and  when  P = 0,  y = 6a^  -6a + 2 . 
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Substituting  (67)  into  (65)  yields 


dety„„  =^a'(3a'-3a  + l^ 


(68) 


It  is  interesting  to  note  that  det  Jam  is  dependent  only  to  the  value  of  a.  It  is 

3V3 

independent  to  a value  of  p.  When  a = 0 or  1,  det  Ja,,,  has  maximum  value  of , 

4 

1 3V3 

and  when  a = — , det  Jam  becomes  minimal,  det  . 

This  6-6  platform  with  a = — , J3  =—  and  y = l (or  & = a)  is  shown  in  the  optimal 

4 6 

V7 

configuration  in  Figure  15  and  for  which,  from  (63),  h absolute  maximum  of 


2lV^  , 

det  7^  is from  (68). 
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Figure  15  : Spatial  6-6  platform  in  optimal  configuration 
(a=  1/4,  p=  1/6,  b=  a,  h = ^a/l2) 


CHAPTER  7 

COMPATABLITY  OF  THE  RESULTS  OF  THE  3-3,  3-6,  6-6  PLATFORMS 


The  maximum  values  of  determinants  of  Jacobian  matrix  which  is  used  for  quality 
index  for  a 3-3  octahedron,  a spatial  3-6  and  a spatial  6-6  platform  device  have  been 
obtained. 

For  the  3-3  octahedral  platform  device  and  the  3-6  device,  the  absolute  maximum 

3^/2 

value  of  the  determinant  of  J,  detJ^^  = —^a^,  which  is  the  volume  of  an  octahedron 

with  equilateral  triangular  moving  platform  with  side  a and  an  equilateral  base  side  2a. 
The  value  of  det  Jam  for  a 3-6  device  with  the  same  moving  platform  ABC  (side  a)  is  the 

3V3 

same,  det  ■ Figure  16  illustrates  the  compatibility  of  these  two  results.  It  can 

be  observed  that  as  the  distance  between  the  pairs  of  separation  points  of  the  double  ball 
and  socket  joints  E^,  Eb  and  Ec  of  the  original  octahedron  are  increased  the  value  of  h is 
decreased  from  h = ato  obtain  the  configuration  for  which  det  J = det  . These  results 


are  analogous  to  the  planar  case  (see  Figure  1)  for  which  det  7^^ 


3/ 

= — regardless  of  the 


location  of  base  pivots. 

However,  for  the  6-6  device,  the  result  is  different  than  those  for  the  3-3 
octahedral  or  the  3-6  devices.  The  reason  is  that  there  is  a reduction  of  overall  size  of  the 
moving  platform.  Because  the  absolute  maximum  value  of  the  determinant  of  the 
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Jacobian  matrix  solely  relies  on  the  dimension  of  the  moving  platform,  once  the  double 
joints  of  the  moving  platform  are  separated,  the  dimension  of  the  platform  changes.  For 

example  (see  Figure  17),  when  « = ^,  the  pair  of  separated  joints  of  the  moving  platform 

recombine  in  a different  sequenee  to  form  double  joints  again.  The  joints  B2C1  and 


a 


C2A1  now  combine  to  form  double  joints  and  hence  a moving  triangle  with  sides  — . The 
6-6  platform  has  thus  reduced  to  a new  3-6  platform.  With  this  eonfiguration,  from  (68), 


and  also  from  (59)  with  a = — , det 


^ aY  3V3  3 

a . 

\^J 
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Now  it  is  clear  that  the  absolute  maximum  values  of  det  J for  octahedral  3-3 
platform  device  and  spatial  3-6  device  which  both  have  an  equilateral  triangular  moving 

3"j3 

platform  are  the  same,  detJ^,„=^— . For  the  spatial  6-6  device,  the  absolute 

maximum  value  of  det  J depends  on  the  separation  of  the  joints  which  changes  the 
dimension  (or  shape)  of  the  moving  platform  and  also  when  the  shape  of  the  moving 
platform  is  getting  close  to  a triangle,  the  value  of  det  Jam  inereases.  But  it  does  not 

3V3 

exceed , whieh  is  the  value  for  the  3-3  and  3-6  deviees. 
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Figure  16  : Compatibility  between  the  3-3  octahedral  platform  and  the  3-6  platform 


Figure  17  : Reduction  of  the  size  of  the  moving  platform  when  a = 1/2 


CHAPTER  8 

OTHER  ALTERNATIVE  JOINT  SEPARATIONS 


Quality  indexes  for  some  simple  spatial  platform  devices  have  been  analyzed  and 
they  have  given  ideas  on  how  to  design  a platform.  Still,  there  is  a lot  more  to  discover 
about  singularities  and  configurations  that  cause  them.  All  the  platforms  analyzed  so  far, 
have  been  derived  from  an  octahedron  platform  because  an  octahedron  is  one  of  the 
strongest  polyhedrons  that  have  triangular  faces  such  as  the  tetrahedron  and  icosahedron. 
There  are  more  ways  to  separate  double  joints  other  than  those  discussed  in  this 
dissertation.  As  we  pointed  out  with  the  6-6  platform  device,  certain  arrangements  of  six 
joints  on  the  moving  and  base  platform  cause  certain  degenerate  conditions.  They  are  not 
always  easy  to  find  but  at  least  some  of  them  can  be  determined  using  the  quality  index 
analysis  technique. 

Joint  Separation  Toward  the  Center  of  the  Platform 

Figure-18  illustrates  the  plan  view  of  a platform  with  one  of  each  double  joints 
moved  toward  the  center  of  the  platform.  These  joints  are  separated  by  a distance  pda 
from  the  moving  platform  joints  and  pdt,  from  the  base  joints  where  dg  is  the  distance 
from  the  joints  of  the  moving  platform  to  the  center  of  the  moving  platform  and  di,  is  the 
distance  from  the  base  joints  to  the  base  center.  The  value  p varies  from  0 to  1.  The 
moving  platform  is  raised  to  distance  h from  the  base.  Each  of  the  six  legs  EaiAi,  EaiA2, 
EbjB],  EB2B2,  EciC]  and  EC2C2  are  S-P-S  connector  chains. 
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The  coordinates  of  the  points  y4/,  Bj,  Ci,  A2,  B2,  C2,  Eai,  Ea2,  Ebu  Eb2,  Eqi  and  Ec2 
are  determined  with  O located  at  the  center  of  the  base  platform  to  determine  the  Pliicker 
coordinates  of  the  six  legs.  Because  the  pairs  of  the  connector  legs  of  the  platform  are 
not  symmetrical  about  the  lines  OEai  , OEbi  and  OEci,  the  platform  must  be  rotated 
about  the  Z-axis  to  reach  the  optimal  configuration.  This  rotation  factor  6 is  added  to  the 
top  platform  joint  coordinates  and  they  are, 
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(69) 


By  following  the  same  steps  (3)  through  (12),  the  length  of  the  three  inner  legs  is, 
/,  = J— (3/2^  + a^(l-  p)“  +fo^(l-p)^  -abi\-  cosO  - yf3ab(l-  p)^  sins)  (70) 


and  the  length  of  the  three  outer  legs  is 


/„  = -abcosG  + yfiabsmO  + b^  +3/i“) 


(71) 
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The  determinant  of  Jacobian  matrix  of  the  six  legs  is, 

3a'Z7'/i'(l-p)'(V3(p'  -2p  + 2)cos0-(p'-2p  + 2)sin0) 


det  y = 


(72) 


It  is  clear  that  det  7 = 0 when  p = 1 . Differentiating  (72)  with  respect  to  h,  det 
occurs  when 


/z= J-(a“(l-p)^  +nV(l-p)^  +2a^b^'{l-p)~  cos26 -2at(a^  +&^)(l-p)^  cos0+&‘‘(l-p)^) 


(73) 


Unfortunately,  it  is  difficult  to  continue  the  investigation  of  det  J„,  analytically 
because  the  equation  of  det  Jm  becomes  too  complex.  Now,  the  dimensions  of  the 
plaform  are  substituted  with  a=\  and  b=2  and,  from  (73), 


- p)^(21  + 8cos20  - 2Ocos0) . 


Figure-19  illustrates  the  values  of  det  Jm  versus  the  values  of  the  separation  factor 


p.  When  p=0,  det  7,„  has  the  maximum  value  of  1.2990  or 


3^3 

4 


which  is  the  same  as  det 


Jm  of  the  3x3  octahedral  platform  and  when  p=l,  the  det  Jm  equals  to  zero  where  the 


platform  is  in  a singularity. 
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P 

Figure  19  : det  J„,  vs  p (platform  with  joints  separated  toward  the  center) 


Figures-20  and  21  illustrate  the  relations  between  p and  G and  between  p and  h 
when  det  occurs.  For  example,  when  p = 0.2  the  platform  must  be  rotated  by  -3.7° 
about  Z-axis  and  raised  by  0.8938  from  the  base  to  reach  its  optimum  configuration.  It  is 
interesting  to  note  that  when  the  separation  value  p increases,  the  platform  rotates  more 
about  the  Z-axis  (negative  direction)  and  translates  lower  along  the  Z-axis  from  the 
optimal  configuration  of  the  3x3  octahedral  platform  to  reach  its  optimal  configuration 
(see  Figures-20  and  21). 
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Figure  20  : Z-axis  rotation  vs  p (platform  with  joints  separated  toward  the  center) 


P 

Figure  21  : /i  vs  p (platform  with  joints  separated  toward  the  center) 
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Figure-22  illustrates  the  plan  view  of  the  platform  with  a=\,  b=2  and  p =0.1  in 
the  optimal  configuration.  The  platform  is  raised  by  0.95  from  the  base.  When  the 
platform  departs  from  its  optimal  configuration  the  det  J always  decreases  - the  quality 
index  is  less  than  1.  Figures-23  through  27  illustrate  the  variation  of  the  quality  index 
when  the  platform  in  Figure-22  moves  away  from  the  optimal  configuration. 


Figure  22  : Optimal  configuration  of  the  platform  with  the  joints  separated  toward  the 

center 
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The  quality  index  varies  in  concentric  circular  shapes  when  the  platform  translates 
parallel  to  the  x-y  plane  (see  Figure-23)  and  has  the  optimal  value  of  1 at  the  center 
where  x = 0 and  y = 0.  The  quality  index  increases  as  the  platform  is  raised  from  the  base 
and  it  becomes  1 when  the  platform  reaches  the  height  of  0.95  (see  Figure-24).  Once  the 
platform  reaches  its  optimal  height,  the  quality  index  starts  decreasing  as  the  height 
increases. 

A singularity  occurs  when  the  platform  rotates  -75°  and  +105°  about  the  X-axis, 
±90°  about  the  Y-axis  and  -85°  and  +95°  about  the  Z-axis  (see  Figures-25  through  27). 


X 

Figure  23  : Variation  of  quality  index  on  x-y  plane  : contours  of  quality  index  (platform 

with  joints  separated  toward  the  center) 
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Figure  24  ; Variation  of  quality  index  along  Z-axis  (platform  with  joints  separated  toward 

the  center) 


X-axis  rotation  (degree) 

Figure  25  : Variation  of  quality  index  when  platform  rotates  about  X-axis  (platform  with 

joints  separated  toward  the  center) 


47 


Y-Axis  Rotation  (degree) 

Figure  26  : Variation  of  quality  index  when  platform  rotates  about  Y-axis  (platform  with 

joints  separated  toward  the  center) 


Z-Axis  Rotation  (degree) 

Figure  27  : Variation  of  quality  index  when  platform  rotates  about  Z-axis  (platform  with 

joints  separated  toward  the  center) 
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Joint  Separation  Along  One  Side  of  the  Triangle 

Figure-28  illustrates  the  plan  view  of  a platform  with  one  of  each  double  joints 
moved  along  the  triangle  edges  of  the  platform.  These  joints  are  separated  by  distance  pb 
for  the  base  joints  and  pa  for  the  moving  platform  joints  ( 0 < p < 1 ).  The  moving 
platform  is  raised  to  distance  h.  The  six  legs  connecting  the  outer  base  joints  to  the  inner 
platform  joints  {EaiAj,  EbiBj,  EctCj)  and  the  the  inner  base  joints  to  outer  platform  joints 
{EA2A2,  EB2B2,  EC2C2)  are  S-P-S  cormector  chains  as  before. 

Because  this  platform  also  has  non-symmetrical  pairs  of  the  connector  legs,  the 
rotation  0 of  the  top  platform  about  the  Z-axis  is  added  to  the  top  platform  joint 
coordinates.  All  the  joint  coordinates  are, 
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Figure  28  : Platform  with  joints  separated  along  one  edge  of  the  triangles 
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By  following  the  same  steps  (3)  through  (12),  the  length  of  the  three  legs  of 
EaiAi,  EbiBj  and  EcjCj  is, 


^1.3,5  - +a^(3p^  -3p  + l)-(cos0 + ^{2p-i)sin6)ab  + b^) 


and  the  length  of  the  three  legs  of  EA2A2,  EB2B2  and  EC2C2  is. 


^2,4.6  - (cos  0 - y/3  (2  p - 1)  sin  0)ab  + b^  (3  p~  -3p  + l)) 


The  determinant  of  Jacobian  matrix  of  the  six  legs  is. 


(75) 


(76) 


dety 


3^a^b^h^(6p^  -15p‘‘  + 20p^  -15p^  +6p  -l)cos0 


4/’ 

^M.3,5‘2,4,6 


(77) 


It  is  clear  that,  from  the  factor  (6p^  -15p‘*  +20p^  -15p^  +6p-l)  in  (77),  when 

p = 1/2  , the  platform  is  in  a singularity.  And  also  when  the  platform  rotates  90“  about  the 
Z-axis,  the  platform  is  also  in  a singularity. 

Using  the  platform  dimensions  of  a=l  and  b=2,  the  relations  between  det  and  p, 
between  6 and  p and  between  h and  p are  illustrated  in  Figures-29  through  31. 

3 /3 

The  det  has  the  maximum  value  of  1.2990  or when  p=0  and  after  that  the 


det  J„,  decreases  as  p increases.  As  previous  mentioned  (see  (77)),  when  p=0.5,  det  7,„ 
equals  to  zero  and  the  platform  is  in  a singularity  everywhere  (see  Figure-29). 
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Figure  29  : dQiJm  vs  p (platform  with  joint  separated  along  one  edge  of  the  triangle) 

It  is  interesting  to  note  that  the  angle  of  rotation  about  Z-axis  of  the  top  platform 
increases  to  reach  the  optimal  configuration  as  p increases  and  when  p reaches  at  the 
value  of  0.32,  the  angle  of  rotation  starts  decreasing.  The  height  h decreases  as  p 


increases. 


52 


P 

Figure  30  : Z-axis  rotation  vs  p (platform  with  joint  separated  along  one  edge  of  the 

triangle) 


P 

Figure  31  \h\sp  (platform  with  joint  separated  along  one  edge  of  the  triangle) 
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Figure-32  illustrates  the  platform  with  a—\,  b—2  and  p — 0.1.  It  has  the  maximum 
determinant  value  of  1.0347  when  the  platform  rotates  7.73°  about  Z-axis  and  raised  0.86 
from  the  base. 

I 

y 


Figure  32  : Optimal  configuration  of  platform  with  joint  separated  along  one  edge  of  the 

triangle 

As  it  is  mentioned  earlier,  moving  the  platform  away  from  the  optimal 
configuration  makes  the  quality  index  decrease.  Figures  33  through  37  illustrates  the 
quality  index  variations  when  the  platform  departs  from  its  optimal  configuration. 


54 


The  quality  index  varies  in  distorted  concentric  circles  which  are  symmetrical  to 
the  dotted  lines  when  the  platform  translates  parallel  to  the  x-y  plane  and  has  the  optimal 
value  of  1 at  the  center  where  x = 0 and  y = 0 (see  Figure-33).  The  quality  index 
increases  as  the  platform  is  raised  from  the  base  and  it  has  the  highest  value  of  1 when  the 
platform  reaches  the  height  of  0.86  (see  Figure-34).  Once  the  platform  reaches  its  optimal 
height,  the  quality  index  starts  decreasing  as  the  height  increases. 

A singularity  occurs  when  the  platform  rotates  -71°  and  +108°  about  X-axis,  -95° 
and  +85°  about  Y-axis,  and  -98°  and  +82°  about  Z-axis  (see  Figure-35  through  37). 


X 

Figure  33  : Variation  of  quality  index  on  x-y  plane  : contours  of  quality  index  (platform 
with  joint  separated  along  one  edge  of  the  triangle) 
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Figure  34  : Variation  of  quality  index  along  Z-axis  (platform  with  joint  separated  along 

one  edge  of  the  triangle) 


X-axis  rotation  (degree) 

Figure  35  : Variation  of  quality  index  when  platform  rotates  about  X-axis  (platform  with 
joint  separated  along  one  edge  of  the  triangle) 
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36  : Variation  of  quality  index  when  platform  rotates  about  Y-axis  (platform  with 
joint  separated  along  one  edge  of  the  triangle) 


Z-Axis  Rotation  (degree) 

Figure  37  : Variation  of  quality  index  when  platform  rotates  about  Z-axis  (platform  with 
joint  separated  along  one  edge  of  the  triangle) 


CHAPTER  9 

DEVELOPMENT  OF  WEB  BASED  INTERACTIVE  GRAPHICAL  DESIGN  AND 

ANALYSIS  TOOL 


The  plots  shown  earlier  present  variations  of  quality  indices  on  x-y-z  translations 
and  rotations  about  x-y-z  axes,  however,  they  do  not  give  enough  information  on  how  the 
quality  index  varies  over  the  platform’s  workspace.  Therefore,  an  interactive  computer 
graphic  simulation  program  that  shows  variations  of  quality  indices  of  a platform  device 
and  the  corresponding  configurations  was  developed. 

Of  the  many  3D-graphical  tools  available  for  this  task  such  as  OpenGL,  Open 
Inventor,  Direct  3D  and  VRML,  VRML  was  used  for  the  3D  graphics  interface  and  Java 
for  the  programming  part.  These  were  chosen  because  they  are  standard  World  Wide 
Web  protocols  for  3D  graphics  and  programming  language.  The  simulation  is  available 
on  the  internet  and  can  be  run  from  anywhere  in  a Java  enabled  browser  that  contains  a 
VRML  plugin.  This  can  be  called  “distributed  simulation.”  Distributed  simulation  has 
many  advantages  over  conventional  programming  methods.  One  of  them  is  data  sharing 
over  the  internet. 

Since  it  is  difficult  to  find  a maximum  determinant  value  of  the  Jacobian  matrix  of 
the  platforms,  it  is  necessary  to  collect  all  the  values  of  the  maximum  determinants  found 
previously  and  store  them  in  a database.  This  data  can  then  be  shared  through  an  internet 
server. 
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Java  applets  are  used  to  provide  dynamic  content  on  a Web  page  and  they  are  also 
used  to  deliver  data  to  a client  system  from  the  server.  An  applet  can  make  a connection 
to  the  host  it  was  loaded  from  and  it  can  also  send  user  input  data  to  the  server.  Java 
provides  several  easy-to-use  sets  of  APIs  for  networking  including  socket  and  packet 
based  protocols.  However,  direct  socket  connection  between  client  and  server  is  not 
recommended  because  of  a possible  network  security  problem.  Most  commercial  internet 
servers  do  not  allow  direct  socket  connection  from  clients.  Even  though  socket 
networking  is  very  powerful,  it  is  not  going  to  be  used  for  the  development  of  the  design 
and  analysis  tool  for  the  platform. 

Below  is  the  required  hardware  and  software  lists  and  some  brief  information 
about  the  technologies  used  to  develop  the  design  tool. 

Specifications 

Hardware 

Client  : PC  running  Windows  95/NT  or  Silicon  Graphics  Workstation 

Server  : PC  or  any  workstation  running  Microsoft  Internet  Information  Server  4.0 

Software 

Client  ; Web  Browser  (Netscape  Communicator  4.06  or  Internet  Explorer  4.01) 

Cosmo  Player  2.1  (1.02  for  SGI)  plugin 
Server  : Microsoft  Windows  NT  Workstation  or  Server  4.0 


Microsoft  Internet  Information  Server  4.0 
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Programming  Languages  and  tools 


VRML 

VRML  stands  for  Virtual  Reality  Modeling  Language.  It  became  a standard  3D 
graphic  language  for  the  Internet  around  1996.  The  current  version  of  VRML  is  VRML97 
which  became  an  International  Standard  in  1997.  In  the  beginning,  VRML  was  a purely 
static  3D-scene  description  language  (VRMLl.O).  The  later  version  2 (VRML  2.0) 
introduced  animation  and  programmable  behavior.  VRML97  is  the  official  standard  of 
VRML  2.0  and  98%  compatible  with  VRML  2.0.  One  of  the  new  features  in  VRML97  is 
the  external  authoring  interface  (EAI)  with  which  a VRML  scene  can  be  manipulated  by 
an  external  program.  VRML  scenes  can  be  prepared  by  CAD  programs  such  as 
AutoCAD  and  Pro/Engineer  and  then  converted  to  a VRML  format. 

Java  and  JavaScript 

Java  is  a platform-independent  programming  language  and  only  programming 
language  which  VRML  can  be  bound  with  now.  Many  Java  development  tools  are 
available  such  as  JDK,  Visual  J-i-i-  and  so  on.  JDK  will  be  used  for  compiling  Java 
programs.  The  version  of  JDK  has  changed  from  1.0  to  1.1,  and  soon  it  will  be  1.2. 
Currently,  Java  programs  are  prepared  using  JDK  1.1,  but  later,  when  version  1.2  is 
released,  all  the  programs  will  be  upgraded. 

JavaScript  is  originally  developed  by  Netscape  and  its  syntax  is  based  on  the  Java 
programming  language.  It  is  used  for  creating  dynamic  content  on  HTML  pages.  Since 
JavaScript  is  a scripting  language  it  doesn’t  need  to  be  compiled  to  be  executed. 
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VBScript 

Microsoft  Visual  Basic  Scripting  Edition  (VBScript)  is  a subset  of  the  Microsoft 
Visual  Basic  language.  It  is  implemented  as  an  interpreter  for  use  in  World  Wide  Web 
browsers  similar  to  JavaScript  and  other  applications  that  use  Microsoft  ActiveX 
Controls.  VBScript  is  commonly  used  for  developing  Active  Server  Pages  (ASP)  which 
run  on  the  server  and  not  on  the  client. 

Active  Server  Page  (ASP) 

Active  Server  Pages  (ASP)  is  a server-side  scripting  environment  that  creates 
dynamic  Web  pages  or  builds  Web  applications.  ASP  pages  are  files  that  contain  HTML 
tags,  text,  and  script  commands  (VBScript).  ASP  pages  can  call  ActiveX  components  to 
perform  tasks,  such  as  connecting  to  a database  or  performing  an  external  calculation. 
Microsoft  Internet  Information  Server  is  the  only  HTTP  server  that  can  process  ASP 
pages. 

Remote  Scripting 

Remote  scripting  allows  for  client/server-type  interactions  between  the  browser 
and  the  Web  server.  The  web  application  can  validate  the  user  entries  without  having  to 
reload  the  page.  Specifically,  the  script  must  first  identify  a server  page  to  connect  to, 
then  transmit  the  call  to  the  server.  Any  return  value  from  the  call  is  transmitted  back  to 
the  originating  script. 
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ODBC  (Open  DataBase  Connectivity) 

Open  Database  Connectivity  (ODBC)  is  a widely  accepted  application 
programming  interface  (API)  for  database  access.  It  is  based  on  the  Call-Level  Interface 
(CLI)  specifications  from  X/Open  and  ISO/IEC  for  database  APIs  and  uses  Structured 
Query  Language  (SQL)  as  its  database  access  language. 

When  programming  to  interact  with  QDBC  you  only  need  to  talk  the  QDBC 
language  (a  combination  of  ODBC  API  function  calls  and  the  SQL  language).  The 
ODBC  Manager  will  figure  out  how  to  contend  with  the  type  of  database  you  are 
targeting.  Regardless  of  the  database  type  used,  all  of  the  calls  will  be  to  the  ODBC  API. 
All  that  needs  is  an  ODBC  driver  that  is  specific  to  the  type  of  database. 

System  Design 

Figure-38  illustrates  the  system  structure  of  the  analysis  tool.  It  has  client  and 
server  side  components.  The  client  side  components  are  consist  of  VRML  and  Java 
Applet  and  the  server  side  components  are  comprised  of  ASP  and  Win32  program  which 
performs  a numerical  search  of  the  maximum  value  of  the  determinant  of  the  Jacobian 
matrix  of  the  platform.  The  database  used  for  the  project  is  Microsoft  Access  and  it  is 
provided  by  ODBC  driver  installed  on  the  server  machine. 

Once  all  the  program  codes  of  the  analysis  tool  are  loaded  to  a client  machine,  A 
user  can  evaluate  the  configuration  of  the  platform  using  the  graphical  user  interface 
provided  by  the  Java  Applet  and  the  built-in  interface  of  the  VRML  browser  (Cosmo 
Player).  The  client  machine  connects  the  server  again  when  the  user  needs  to  get  the 
maximum  value  of  the  determinant  of  the  Jacobian  matrix  of  the  platform.  The  client 
program  sends  the  configuration  data  of  the  platform  to  the  server  through  the  standard 
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HTTP  protocol.  The  configuration  data  has  two  parts,  top  configuation  and  the  base 
configuration,  and  each  part  consists  of  x-y  coordinates  of  the  six  joints  coordinates  with 
respect  to  the  center  of  the  top  or  base  platform.  Those  joint  coordinates  are  divided  by 
the  length  from  the  center  of  the  platform  to  the  first  joint  position.  These  unitized 
coordinates  are  delimited  by  a character  ‘x’. 

Once  the  configuration  data  is  received  by  the  ASP  page  on  the  server,  the  ASP 
page  searches  the  database  for  the  matching  configuration.  If  the  match  is  found,  the  page 
sends  the  corresponding  maximum  determinant  value  of  the  Jacobian  matrix  back  to  the 
client.  If  there  is  no  matching  configuration,  the  ASP  page  checks  to  see  if  there  are  any 
other  processes  running  for  the  search  of  the  maximum  determinant  value.  If  there  is  one, 
the  ASP  page  sends  a message  notifying  that  there  is  a running  process  and  asks  user  to 
wait  until  the  process  ends.  Otherwise  the  page  calls  a program  which  performs  a 
numerical  search  of  the  maximum  determinant  of  the  given  configuration.  This  program 
updates  the  database  when  it  finishes  the  seareh. 


Client  Server 


Figure  38  : System  Diagram 
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Procedures 

Setup  Client  Side  Components  (Integrating  Java  and  VRML) 

Java  can  be  used  with  VRML  in  two  ways.  VRML  has  a Java  script  node  and 
Java  can  be  used  as  the  scripting  language  for  that  node.  The  Java  script  interacts  with 
the  VRML  world  through  the  Java  Script  Authoring  Interface  (JSAI).  The  JSAI  allows 
Java  to  communicate  with  other  VRML  nodes.  The  Java  script  receives  events  from  a 
node,  executes  the  script,  and  then  sends  the  results  to  other  nodes  as  events.  This  allows 
Java  to  perform  complex  modifications  to  the  objects  in  a VRML  scene. 

Java  can  also  control  a VRML  world  externally,  using  an  External  Authoring 
Interface  (EAI).  The  EAI  allows  one  or  more  VRML  worlds  to  be  added  to  a Java 
program.  This  allows  VRML  to  be  part  of  a larger  or  more  conventional  application. 
The  EAI  allows  almost  the  same  functionality  as  the  JSAI.  Events  can  be  sent  to  VRML 
nodes  and  also  node  states  and  characteristics  are  received  from  other  nodes.  However 
unlike  JSAI,  a VRML  event  itself  cannot  cause  EAI  program  codes  to  be  executed. 
Rather  the  Java  applet  that  contains  the  EAI  codes  controls  a VRML  event  and  nodes. 
Eor  example,  pressing  a button  under  control  of  the  Java  applet  could  cause  an  event  to 
be  sent  to  the  VRML  world  that  would  change  the  characteristics  of  the  scene.  The 
procedure  for  creating  Java/VRML  applet  programs  is  as  follows; 

(a)  Java  codes  are  compiled  with  either  JDK  1.0.2  or  JDK  1.1  depending  on  how  the 
provided  browser  environment  handles  the  bytecodes  (for  example,  Netscape 
Navigator  4.0  does  not  fully  handle  JDK  1.1  produced  bytecode). 

(b)  The  EAI  classes  are  shipped  with  an  EAI  enabled  VRML  browser  and  they  are 
not  part  of  the  standard  JDK  classes.  Therefore  the  CLASSPATH  environment 
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variable  must  be  set  to  point  to  the  directory  in  which  they  are  placed.  EAI 
classes  are  included  in  the  “vrml.extemal.*”  packages.  These  packages  contain 
all  the  classes  and  methods  needed  to  access  the  VRML  world. 

(c)  Before  accessing  the  VRML  world,  a reference  to  the  Browser  class  instance  must 
be  set.  This  class  is  the  reflection  of  the  VRML  world  in  the  Java  applet,  and  it  is 
used  for  all  access  to  the  world.  The  static  Browser.getBrowser( ) method  is  used 
to  get  the  reference. 

(d)  Communicating  with  a particular  node  is  done  by  first  getting  a reference  to  the 
node,  using  the  getNode( ) method.  Because  only  named  nodes  can  be  accessed 
from  the  EAI,  a string  corresponding  to  the  DEE  name  of  a node  in  the  VRML 
scene  is  passed  as  a method  argument. 

(e)  All  VRML  EAI  initializations  are  set  up  in  the  start()  method,  and  not  in  init(). 
This  avoids  the  problem  of  stale  Browser  and  Node  pointers  when  the  user  leaves 
and  then  revisits  the  web  page  containing  this  applet. 

(f)  Once  you  have  a reference  to  a node  you  can  send  events  to  its  eventins  using 
getEventIn(  ) method  and  get  the  current  value  of  its  eventOuts  using  the 
getEventOutO  method. 

(g)  The  create VrmlFromString( ) method  is  used  to  create  nodes  from  scratch  and  add 
them  to  the  scene. 

Setup  Server  Side  Components 

A database  is  set  up  using  Microsoft  Access  on  the  server  and  will  be  used  to  hold 
all  the  maximum  values  of  the  determinant  of  the  platforms  found  by  client  or  calculated 
by  server.  The  database  table  and  fields  are  listed  in  Figure-39.  Once  the  database  file  is 
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created  it  must  be  connected  to  the  ODBC  to  be  accessed  from  Active  Server  Pages  using 
the  ODBC  menu  of  Control  Panel  on  the  server  machine. 


Figure  39  : Database  table  information 


An  ASP  page  is  prepared  for  handling  the  database.  The  Java  applet  which 
controls  the  client  VRML  scene  connects  to  this  ASP  page  through  a HTTP  server  to  get 
the  maximum  determinant  values  from  the  database.  When  the  ASP  page  receives  the 
configuration  data  from  the  client,  it  tries  to  find  the  matching  configuration  from  the 
database.  If  it  finds  one,  it  returns  the  corresponding  maximum  determinant  value.  If  it 
fails  to  find  the  matching  configuration,  it  searches  for  ‘PROCESSING’  in  ‘status’  field 
of  the  database.  If  it  finds  ‘PROCESSING’,  the  ASP  page  sends  ‘WAIT’  message  back  to 
the  client  and  if  there  is  no  entry  of  ‘PROCESSING’  the  ASP  does  as  follows: 
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a)  It  adds  a data  entry  of  the  received  configuration  to  the  database  with 
‘PROCESSING’  in  the  ‘status’  field 

b)  It  executes  the  search  program. 

c)  It  sends  a ‘PROCESSING’  message  back  to  the  client. 

The  program  which  performs  a numerical  search  of  the  maximum  determinant 
value  of  the  Jacobian  matrix  is  coded  using  C++  programming  language  for  the  fast 
calculation.  This  program  has  ODBC  APIs  used  for  connecting  the  database,  getting  the 
configuration  data  and  updating  the  database  entry  after  finishing  the  search. 


Results 

Figure-40  shows  the  client  side  view  of  the  design  tool.  The  left  side  of  the 
browser  screen  displays  the  three-dimensional  graphics  of  the  platform  and  the  right  side 
displays  the  controls  of  the  platform.  A user  can  set  up  the  configuration  of  the  platform, 
control  the  position  and  orientation  of  the  platform,  and  view  the  Jacobian  matrix  and  the 
determinant  value  with  the  help  of  the  buttons  on  the  main  control  panel. 

Clicking  the  “Configuration”  button  brings  up  a dialog  box  shown  in  Figure-41. 
Using  this  dialog,  a user  can  modify  the  geometry  of  the  platform.  There  are  two  sections 
controlling  either  top  or  base.  The  menu  “Type”  indicates  geometry  of  the  platform  and 
“Size”  indicates  size  of  the  platform  - a or  b discussed  earlier  in  this  paper.  If  the  user 
selects  “Hexagon”,  the  joint  separation  menu  will  be  available  for  modifications.  The 
amount  of  the  separation  is  shown  as  a percentage  value,  0 to  100  instead  of  0 to  1. 

The  two  read  colored  ball  joint  on  the  platform  indicates  the  connector  leg  1 and 
the  joint  numbers  of  the  rest  of  the  connector  legs  are  assigned  in  counter  clockwise. 
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Figjare  40  : Web  based  interactive  analysis  tool  for  platform  manipulators 
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Figure  41  : Platform  configuration  dialog 

Pushing  the  button  “Jacobian  Matrix”  will  open  up  an  another  dialog  (see  Figure- 
42)  displaying  the  Jacobian  matrix,  its  determinant  value  and  the  quality  index  if  the 
maximum  determinant  value  of  the  platform  is  available. 


Figure  42  ; Dialog  displaying  Jacobian  Matrix 


CHAPTER  10 
CONCLUSION 

A quality  index,  see  equation  (1),  can  be  easily  used  for  every  fully  in-parallel  six- 
linear-actuator  manipulator  at  any  configuration  once  the  maximum  values  of  the 
determinant  of  the  Jacobian  matrix  for  the  platforms  are  known.  Its  maximum  value,  A,=  1, 
is  attached  to  just  one  particular  central  configuration  of  one  device  and  the  dimensions 
are  specified. 

This  study  supports  the  conclusion  of  Hunt  and  McAree  (1998)  that,  departure 
from  an  octahedral  in  the  direction  of  the  general  6-6  form  progressively  leads  to  poorer 
performance  and  unworkability  coupled  with  considerably  greater  analytical  and 
algorithmic  complications. 

Some  reduction  of  quality  index  1 below  1 is,  of  course,  inevitable  as  the 
manipulator  is  displaced;  it  is  up  to  both  the  designer  and  the  user  to  make  an  intelligent 
judgement  of  a lower  limit  for  some  specific  application. 

No  startling  surprises  are  here  revealed;  in  fact  these  results  and  examples  are  in 
remarkable  conformity  with  common  sense.  A more  complicated  formulation  of  the 
quality  index,  such  as  one  that  includes  a penalty  for  the  shear  bulk  of  the  manipulator 
has  been  deliberately  avoided.  The  imprecision  inherent  in  such  an  elaboration  detracts 
from  the  simplicity  of  this  quality  index  X. 

On  the  matter  of  avoidable  actuator-range,  it  is  recognized  that  a designer  may 
need  to  exercise  considerable  ingenuity  in  achieving  greater  leg-elongation  without  both 
reduction  of  structural  integrity  and  excessive  degradation  of  X. 
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It  is  usually  difficult  to  get  the  maximum  value  of  the  platform  with  non- 
symmetrical  joint  connections.  The  practical  solution  of  the  difficulties  is  provided  by 
developing  a tool  that  will  enable  the  sharing  of  the  design  information  over  the  internet 
using  the  latest  technology. 

In  this  paper,  only  the  non-redundant  six-degree-of-freedom  platform  devices  are 
analyzed.  A certain  singular  configuration  can  be  easily  avoided  by  adding  more  legs  to 
the  platform  which  makes  the  platform  redundant.  It  would  be  fruitful  to  expand  the 
research  to  the  redundant  platforms. 


APPENDIX 
PROGRAM  LISTS 


I.  CONFIG_DATA.JAVA 


//Title:  VRML  Platform 

//Copyright:  Copyright  (c)  2000 

//Author:  Jaehoon  Lee 

package  Platform; 

/*************************************************************** ^ 
/*  platform  configuration  data  class  */ 

/*************************************************************** ^ 

public  class  Config_data 
{ 

boolean  maxdetfound  = true; 
float  maxdet  = 4384.2537f; 
float []  maxpos  = new  float [3]; 
float []  maxrot  = new  float[3]; 
float  top_size  = 15. Of; 
float  base_size  = 30. Of; 
float  alpha  = 10. Of; 
float  beta  = 10. Of; 

String  top_shape  = new  String ( "Triangle" ) ; 

String  base_shape  = new  String ( "Triangle" ) ; 

String  top_separation  = new  String ( "Along  Both  Edges"); 

String  base_separation  = new  String ( "Along  Both  Edges"); 

//  constructor 
public  Conf ig_data ( ) 

{ 

maxpos [0] =0 . Of ; maxpos [ 1 ] =0 . Of ; maxpos[2]=15.0f; 
maxrot [0] =0 . Of ; maxrot ( 1 ] =0 . Of ; maxrot [ 2 ] =0 . Of ; 

} 


//  methods 

public  float  getTopSize()  {return  top_size; } 

public  float  getBaseSize ( ) {return  base_size; } 

public  float  getAlpha()  {return  alpha;) 

public  float  getBetal)  {return  beta;) 

public  String  getTopShape ( ) {return  top_shape; } 

public  String  getBaseShape ( ) {return  base_shape;} 

public  String  getTopSeparation ( ) {return  top_separation; ) 

public  String  getBaseSeparation ( ) {return  base_separation; } 

public  float  getMaxdet ( ) {return  maxdet;} 

public  float)]  getMaxpos ( ) {return  maxpos;} 

public  float]]  getMaxrot ( ) {return  maxrot;} 

public  boolean  getMaxdetFound] ) {return  maxdetfound;} 


public  void 
public  void 
public  void 
public  void 
public  void 
public  void 
public  void 
public  void 
public  void 
public  void 


setTopSize ( float  f)  {top_size=f ; } 
setBaseSize ( float  f)  {base_size=f ; } 
setAlpha ( float  f)  {alpha=f;} 
setBeta ( float  f)  {beta=f;} 
setTopShape ( String  s)  {top_shape=s; } 
setBaseShape (String  s)  {base_shape=s; } 
setTopSeparation( String  s)  {top_separation=s; } 
setBaseSeparation ( String  s)  {base_separation=s; } 
setMaxdet ( float  mj ) {maxdet  = m j ; } 

setMaxdetFound (boolean  truefalse)  {maxdet found=truefal se; } 
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public  void  setMaxpos { float [ ] pos)  { 

maxpos [0] =pos [0] ; maxpos [1 ] =pos [ 1] ; maxpos [2 ] =pos [2 ] ; 

} 

public  void  setMaxpos ( float  x,  float  y,  float  z)  { 
maxpos [0] =x;  maxpos [ 1 ] =y;  maxpos [2 1 =z ; 

} 

public  void  setMaxrot ( float [ ] rot)  { 

maxrot [0]=rot [0] ; maxrot [ 1 ] =rot [1] ; maxrot [ 2 ] =rot [2] ; 

) 

public  void  setMaxrot ( float  rotx, float  roty, float  rotz)  { 
maxrot [0] =rotx;  maxrot [1 ] =roty;  maxrot [2] =rotz ; 

) 

} 


2.  CONFIG  DIALOG.JAVA 


//Title:  VRML  Platform 

//Copyright:  Copyright  (c)  2000 

//Author:  Jaehoon  Lee 

package  Platform; 

import  j ava . awt . * ; 
inport  j ava. awt . event ; 
import  com.borland. jbcl . layout . * ; 
inport  vrml . external . field ; 
import  vrml . external . exception. * ; 
import  vrml .external .Node; 
import  vrml . external . Browser; 

/****************************iiirieiritie******1c*********************1r^ 

/*  configuration  dialog  class  */ 

/***************************************************************/ 

public  class  Conf ig_Dialog  extends  Dialog 

{ 

Panel  pane 11  = new  Panel ( ) ; 

XYLayout  xYLayoutl  = new  XYLayout ( ) ; 

Choice  top_type  = new  Choice ( ) ; 

Choice  base_type  = new  Choice!); 

Choice  top_separation  = new  Choice!); 

Choice  base_separation  = new  Choice!); 

Label  label_Top  = new  Label ! ) ; 

Label  label_Base  = new  Label ! ) ; 

Label  label_top_sep  = new  Label ! ) ; 

Label  label_base_sep  = new  Label!); 

Label  label_alpha_per  = new  Label!); 

Label  label_beta_per  = new  Label ! ) ; 

Label  label_top_type  = new  Label ! ) ; 

Label  label_base_type  = new  Label ! ) ; 

Label  labe_top_size  = new  Label!); 

Label  label_base_size  = new  Label!); 

TextField  alpha  = new  TextField!); 

TextField  beta  = new  TextField!); 

TextField  top_size  = new  TextField!); 

TextField  base_size  = new  TextField!); 

Button  button_ok  = new  Button!); 

Button  button_cancel  = new  Button!); 

//  platform  configuration  data 
Config_data  pdata  = null; 

//  variables  connecting  VRML  scene 
public  EventInSFFloat  stt  = null; 
public  EventInSFFloat  stb  = null; 
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public  EventInSFVec3 f sht  = null; 
public  EventInSFVecBf  shb  = null; 
public  EventInSFBool  set  = null; 
public  EventInSFBool  seb  = null; 

//  constructor 

public  Config_Dialog (Frame  frame,  String  title,  boolean  modal,  Config_data  pd) 

{ 

super (frame,  title,  modal); 
enableEvents (AWTEvent .WINDOW_EVENT_MASK) ; 
pdata  = pd; 
try 
{ 

jblnit ( ) ; 
add (pane 11 ) ; 
paclc  ( ) ; 

) 

catch (Exception  ex) 

{ 

ex . printStac)cTrace  ( ) ; 

) 


void  jblnit ()  throws  Exception 

{ 

panell . setLayout (xYLayoutl ) ; 

xYLayoutl . setHeight ( 300 ) ; 
xYLayoutl . setWidth (360 ) ; 

label_Top. setFont (new  j ava . awt . Font ( " SansSeri f " , 3,  14)); 
label_Top. setForeground( Color .blue) ; 
label_Top. setAlignment (1 ) ; 
label_Top . setText ( "Top" ) ; 

label_Base . setFont (new  java . awt . Font (" SansSerif " , 3,  14)); 
label_Base . setForeground (Color .blue) ; 
label_Base . setAlignment (1 ) ; 
label_Base . setText ( " Base " ) ; 

label_top_sep . setAlignment (1 ) ; 
label_top_sep . setText ( "Joint  Separation") ; 
label_base_sep . setAlignment (1 ) ; 
label_base_sep . setText ( "Joint  Separation" ) ; 
label_alpha_per. setText ("%" ) ; 
label_beta_per . setText ("%"); 
label_top_type . setAlignment ( 1 ) ; 
label_top_type . setText ( "Type" ) ; 
label_base_type . setAlignment (1) ; 
label_base_type . setText ( "Type" ) ; 
labe_top_size. setAlignment ( 1 ) ; 
labe_top_size . setText ( " Size" ) ; 
label_base_size . setAlignment (1 ) ; 
label_base_size . setText ( "Size" ) ; 

top_type.addItem( "Triangle" ) ; 
top_type . addltem( "Hexagon" ) ; 
top_type . addltem( "Custom" ) ; 
top_type . select (pdata . getTopShape ( ) ) ; 

top_type . addItemListener (new  java . awt . event . ItemListener ( ) 

{ 


public  void  itemStateChanged ( ItemEvent  e) 

{ 

top_type_itemStateChanged(e) ; 

) 

) ) ; 

base_type.addltem( "Triangle" ) ; 
base_type.addltem( "Hexagon" ) ; 
base_type.addltem( "Custom" ) ; 
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base_type . select (pdata .getBaseShape ( ) ) ; 

base_type . addltemListener (new  java .awt .event . ItemListener ( ) 
{ 


public  void  itemStateChangeddtemEvent  e) 
{ 

base_type_itemStateChanged(e)  ; 

} 

) ) ; 

if  (pdata . getTopShape ( ) .equals ( "Hexagon" ) ) 

{ 

top_size . setEnabled ( true) ; 
top_separation. setEnabled ( true) ; 
alplia . setEnabled ( true)  ; 

) 

else 

{ 

if  (pdata . getTopSliape ( ) .equals  ( "Custom"  ) ) 
top_size . setEnabled( false) ; 
else 

top_size. setEnabled(true) ; 
top_separation. setEnabled( false) ; 
alplia . setEnabled(  false)  ; 


if  (pdata. getBaseSliape  ( ) .equals  ( "Hexagon" ) ) 

{ 

base_size . setEnabled ( true) ; 
base_separation . setEnabled ( true) ; 
beta . setEnabled ( true ) ; 

} 

else 

{ 

if  (pdata. getBaseSliape  ( ) .equals  ( "Custom" ) ) 
base_size . setEnabled ( false) ; 
else 

base_size . setEnabled( true) ; 
base_separation. setEnabled ( false) ; 
beta . setEnabled ( false) ; 


top_size . setText (Float . toS t ring (pdata. getTopSize ( ) ) ) ; 
base_size . setText (Float . toString (pdata. getBaseSize ())); 

top_separation.addItem( "Along  Both  Edges”); 
top_separation.addItem( "Along  One  Edge"); 
top_separation.addItem( "Toward  Center") ; 
top_separation. select (pdata. getTopSeparation ( ) ) ; 

base_separation.addItem( "Along  Both  Edges"); 
base_separation.addItem( "Along  One  Edge"); 
base_separation.addItem( "Toward  Center") ; 
base_separation. select (pdata . getBaseSeparation ( ) ) ; 

alpha . setText (Float . toString (pdata .get Alpha ( ) ) ) ; 
beta . setText ( Float . toString (pdata . getBeta ( ) ) ) ; 

button_o)c.  setLabel  ( "OK" ) ; 

button_o)< . addActionListener  (new  java,  awt . event . ActionListener  ( ) 
{ 


public  void  actionPerf ormed (ActionEvent  e) 

{ 

button_o)c_actionPerformed(e)  ; 

} 

))  ; 

button_cancel . setLabel ( "Cancel " ) ; 

button_cancel . addActionListener (new  java . awt . event .ActionListener ( ) 
{ 
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public  void  actionPerformed(ActionEvent  e) 

{ 

button_cancel_actionPerf ormed (e) ; 

) 

}); 

panell . add ( label_Top,  new  XYConstraints ( 14 , 17,  161,  26)); 
panell . add ( label_Base,  new  XYConstraints (186,  18,  161,  26)); 
panell .add (label_alpha_per,  new  XYConstraints (167 , 217,  17,  -1)); 
panell .add (label_top_type,  new  XYConstraints ( 15 , 52,  150,  22)); 
panell .add (label_base_type,  new  XYConstraints ( 187 , 52,  150,  22)); 
panell . add ( label_base_size,  new  XYConstraints (187,  116,  150,  23)) 
panell .add(top_type,  new  XYConstraints ( 15 , 84,  150,  23)); 
panell . add (base_type,  new  XYConstraints ( 187 , 83,  150,  23)); 
panell .add (top_separation,  new  XYConstraints ( 15 , 217,  110,  23)); 
panell . add (base_separation,  new  XYConstraints ( 187 , 217,  110,  23)) 
panell . add (alpha,  new  XYConstraints ( 124 , 217,  44,  23)); 
panell . add (beta,  new  XYConstraints (296 , 217,  44,  23)); 
panell .add (top_size,  new  XYConstraints ( 15 , 149,  150,  -1)); 
panell . add (base_size,  new  XYConstraints ( 187 , 148,  150,  -1)); 
panell .add (label_top_sep,  new  XYConstraints ( 15 , 181,  150,  26)); 
panell . add ( label_base_sep,  new  XYConstraints (187 , 180,  150,  26)); 
panell .add (labe_top_size,  new  XYConstraints ( 15 , 116,  150,  -1)); 
panell . add  (button_olt,  new  XYConstraints  ( 69 , 260,  96,  -1)); 
panell . add (button_cancel , new  XYConstraints ( 189 , 260,  96,  -1)); 
panell . add ( label_beta_per,  new  XYConstraints (342 , 218,  17,  -1)); 


void  cancel ( ) 

{ 

dispose ( ) ; 

} 

protected  void  processWindowEvent (WindowEvent  e) 

{ 

if(e.getID()  ==  WindowEvent .WINDOW_CLOSING) 

{ 

cancel ( ) ; 

) 

super .processWindowEvent (e) ; 

} 

/************************************************ ^ 
/*  event  handlers  for  the  AWT  components  */ 

/*  (button,  dropdown  menus,  text  boxes,  etc.)  */ 
/************************************************ ^ 

void  top_type_itemStateChanged(ItemEvent  e) 

{ 

if  (e.getltem( ) .equals ( "Hexagon" ) ) 

{ 

top_size . setEnabled ( true) ; 
top_separation. setEnabled ( true) ; 
alpha . setEnabled ( true) ; 

} 

else 

{ 

if  (e.getltem( ) .equals ( "Custom" ) ) 
top_size . setEnabled( false) ; 
else 

top_size . setEnabled ( true) ; 
top_separat ion. setEnabled (false)  ; 
alpha. setEnabled ( false) ; 

) 


} 

void  base_type_itemStateChanged(ItemEvent  e) 
{ 
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if  (e.getltem( ) .equals ( "Hexagon" ) ) 

{ 

base_size . setEnabled ( true) ; 
base_separation . setEnabled ( true) ; 
beta . setEnabled { true ) ; 

} 

else 

{ 

if  (e.getltem( ) .equals ( "Custom" ) ) 
base_size . setEnabled( false) ; 
else 

base_size . setEnabled ( true) ; 
base_separation . setEnabled( false) ; 
beta . setEnabled ( false) ; 


void  button_ok_actionPerformed(ActionEvent  e) 

{ 

float!]  jdata  = new  float [3]; 
float  djm,h,  a,b,  ap,bt; 

//  set  the  config  data  according  to  the  user  input 
pdata.setTopShape(top_type.getSelectedItem() ) ; 
pdata . setBaseShape (base_type .getSelectedltem] ) ) ; 

pdata . setTopSeparation ( top_separation .getSelectedItem] ) ) ; 
pdata. setBaseSeparation (base_separation .getSelectedItem] ) ) ; 

a=Float . valueOf  (top_size.getText  ( ) ) . f loatValue  ( ) 
b=Float . valueOf (base_size .getText ( ) ) . f loatValue ( ) ; 
pdata . setTopSize (a) ; 
pdata. setBaseSize (b) ; 

pdata. set Alpha (Float .valueOf (alpha. getText ( ) ) . f loatValue ( ) ) 
pdata . setBeta (Float .valueOf (beta .getText ( ) ) . f loatValue ( ) ) ; 

ap=Float .valueOf (alpha. getText ( ) ) . f loatValue ( ) /lOO . Of ; 
bt=Float .valueOf (beta . getText ( ) ) . f loatValue ( ) /lOO . Of ; 

if  ( pdata. getTopShape ( ) . equals ( "Triangle" ) ) 

{ 

top_separat ion. setEnabled ( false) ; 

alpha . setEnabled ( false) ; 

stt . setValue (pdata. getTopSize ( ) ) ; 

} 

if  (pdata . getBaseShape ( ) . equals ( "Triangle" ) ) 

{ 

base_separ at ion. setEnabled (false) ; 

beta . setEnabled  ( false) 

stb. setValue (pdata . getBaseSize ( ) ) ; 

) 

if  (pdata. getTopShape ( ) .equals ( "Custom" ) ) 

{ 

top_separation. setEnabled ( false) ; 
alpha  . setEnabled(  false) 
set . setValue ( true ) ; 

) 

if  (pdata. getBaseShape ( ) .equals ( "Custom" ) ) 

{ 

base_separation . setEnabled  ( false) 
beta. setEnabled ( false) ; 
scb. setValue ( true) ; 

) 

if  (pdata.getTopShape( ) . equals ( "Hexagon" ) ) 

{ 

jdata[0]  = pdata.getTopSize(); 
jdata [1]  = pdata. get Alpha () ; 

if  (pdata.getTopSeparationO  .equals  ("Along  Both  Edges")) 
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{ 

jdata ( 2 1 =0 . Of ; 

} 

if  (pdata .getTopSeparation 0 .equals ( "Along  One  Edge”)) 
{ 

jdata [ 2 ] =1 . Of ; 

} 

if  (pdata .getTopSeparation (). equals ( "Toward  Center")) 

{ 

jdata [ 2 ] =2 . Of ; 

) 

sht . setValue ( jdata) ; 


if  (pdata.  get BaseStiape  ( ) . equals  ( "Hexagon" ) ) 

{ 

jdata [0]  = pdata. getBaseSize () ; 
jdata[l]  = pdata .getBeta () ; 

if  (pdata . getBaseSeparation (). equals ( "Along  Both  Edges”)) 
{ 

jdata[21=0.0f 

} 

if  (pdata . getBaseSeparation (). equals ( "Along  One  Edge")) 

{ 

jdata (2 ] =1 . Of ; 

} 

if  (pdata . getBaseSeparation (). equals ( "Toward  Center")) 

{ 

jdata [2 ] =2 . Of ; 

} 

shb. setValue ( jdata) ; 


h=a; 

djm=-0.0001f; 

pdata. setMaxdetFound( false) ; 

//  calculate  Icnown  DetJm 

if  (pdata . getTopShape ( ) . equals ( “Triangle" ) ) 

{ 

if  (pdata . getBaseShape ( ) . equals ( "Triangle" ) ) 

{ 

djm= (float) (27.0*a*a*a*b*b*b/ ( 32*Math . sqrt (Math.pow(a*a-a*b+b*b, 3 ) ) ) ) 
h=  ( float ) (Math. sqrt ( (a*a-a*b+b*b) /3)); 
pdata . setMaxdetFound( true) ; 

) 

if  (pdata .getBaseShape ( ) . equals ( "Hexagon" ) 

&&  pdata . getBaseSeparation (). equals ( "Along  Both  Edges")) 

{ 

djm= (float) (27 . 0*a*a*a*b*b*b*Math .pow ( 2*bt- 1 , 3) 

/ ( 32 ‘Math. sqrt (Math. pow ( a*a-a*b+b*b* (3 ‘bt*bt-3 ‘bt+1 ) , 3 ) ) ) ) ; 
h= ( float ) (Math. sqrt ( (a*a-a*b+b*b* ( 3*bt*bt-3*bt+l ) ) /3 ) ) ; 
pdata . setMaxdetFound( true) ; 

} 


if  (pdata. getTopShape ( ) . equals ( "Hexagon" ) 

&&  pdata . getBaseShape ( ) .equals ( "Hexagon" ) 

&&  pdata. getTopSeparation( ) .equals ( "Along  Both  Edges") 

&&  pdata. getBaseSeparation( ) .equals ( “Along  Both  Edges")) 

{ 

djm= ( float ) (27 . 0*a*a*a*b*b*b*Math.pow( 3*ap*bt-2*ap-2*bt+l , 3 ) 
/ (32*Math. sqrt (Math.pow(a*a* (3*ap*ap-3*ap+l) 

+a*b* (3*ap*bt-l) +b*b* (3‘bt*bt-3*bt+l) ,3)))); 
h= ( float ) (Math. sqrt ( (a* a* ( 3*ap*ap-3  *ap+l ) 

+a*b* (3*ap*bt-l) +b*b* (3*bt*bt-3*bt+l) )/3)); 
pdata . setMaxdetFound ( true) ; 


pdata . setMaxdet (Math . abs (djm) ) ; 
pdata . setMaxpos ( 0 . Of , 0 . Of , h) ; 


78 


pdata . setMaxrot (0.0f,0.0f,0.0f) ; 
dispose ( ) ; 

) 

void  button_cancel_actionPerformed (ActionEvent  e) 

{ 

dispose ( ) ; 

) 


} 


3.  JB_DIALOG.JAVA 


//Title: 

/ /Copyright : 
//Author: 


VRML  Platform 
Copyright  (c)  2000 
Jaehoon  Lee 


package  Platform; 

import  java.awt.*; 

import  j ava . awt . event ; 

import  com. borland. jbcl . layout ; 

/****************************************************************/ 
/*  Jacobian  matrix,  DetJ  and  Quality  index  display  dialog  class  */ 

/**************************************************************** y 


public  class  JB_Dialog  extends  Dialog 

{ 

Panel  panell  = new  Panel () ; 

XYLayout  xYLayoutl  = new  XYLayout ( ) ; 


TextField  textFieldll 
TextField  textFieldl2 
TextField  textFieldll 
TextField  textFieldl4 
TextField  textFieldll 
TextField  textFieldlO 
TextField  textField21 
textField22 
textField23 
TextField  textField24 
TextField  textField25 
TextField  textField26 
textFieldll 
textFieldl2 
textFieldll 
TextField  textFieldl4 
TextField  textFieldll 
TextField  textFieldlO 
TextField  textField41 
TextField  textField42 
TextField  textField41 
TextField  textField44 
TextField  textField45 
TextField  textField46 
TextField  textFieldll 
TextField  textFieldll 
TextField  textFieldll 
TextField  textFieldl4 
TextField  textFieldll 
TextField  textFieldlO 
TextField  textFieldOl 
TextField  textField62 
TextField  textFieldSl 
TextField  textField64 
TextField  textFieldOl 


TextField 

TextField 


TextField 

TextField 

TextField 


new  TextField 
new  TextField 
new  TextField 
new  TextField 
new  TextField 
new  TextField 
new  TextField 
new  TextField 
new  TextField 
new  TextField 
new  TextField 
new  TextField 
new  TextField 
new  TextField 
new  TextField 
new  TextField 
new  TextField 
new  TextField 
new  TextField 
new  TextField 
new  TextField 
new  TextField 
new  TextField 
new  TextField 
new  TextField 
new  TextField 
new  TextField 
new  TextField 
new  TextField 
new  TextField 
new  TextField 
new  TextField 
new  TextField 
new  TextField 
new  TextField 
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TextField  textField66  = new  TextField ( ) ; 

Label  labell  = new  Label!); 

TextField  textField_det  = new  TextField!); 

TextField  textField_qi  = new  TextField!); 

Label  label2  = new  Label!); 

Button  ok_button  = new  Button  1 "Close” ) ; 

/ / constructor 

public  JB_Dialog !Frame  frame.  String  title,  boolean  modal , float [][ ] jmat, 
float  det j , float  qi  ) 

{ 

super!frame,  title,  modal); 
enableEvents lAWTEvent .WINDOW_EVENT_MASK) ; 
try 
{ 

jblnit ! ) ; 
add Ipanell ) ; 
pac)t ! ) ; 

) 

catch ! Exception  ex) 

{ 

ex.printStaclcTrace ! ) ; 

} 

textFieldll . setText ! Float . toString ! ! f loat) Math. round ! jmat [0] [0]*1000)/1000f) ) 
textFieldl2 . setText 1 Float . toString ! ! f loat ) Math. round! jmat [0] (l]*1000)/1000f)) 
textFieldll . setText 1 Float . toString ! ! f loat ) Math. round ! jmat [0] [2]*1000)/1000f) ) 
textFieldl4 . setText 1 Float . toString ! ! float ) Math . round ! jmat [0] [3]*1000)/1000f)) 
textFieldlS . setText 1 Float . toString ! ! f loat ) Math. round! jmat [0] [4)*1000)/1000f)) 
textFieldl6 . setText I Float . toString ! ! float) Math. round ! jmat [0] [5]*1000)/1000f)) 
textField21 . setText ! Float . toString ! ! float ) Math. round! jmat [1] [0]*1000)/1000f)) 
textField22 . setText ! Float . toString ! ! float) Math . round! jmat [1] [l]*1000)/1000f)) 
textField23 . setText  I Float . toString ! ! f loat ) Math . round ! jmat [1] [2]*1000)/1000f) ) 
textField24 . setText ! Float . toString ! ! float ) Math . round ! jmat [1] [3]*1000)/1000f) ) 
textField25 . setText ! Float . toString ! ! float ) Math. round! jmat [1 ] [4]*1000)/1000f)) 
textField26 .setText ! Float .toString! I float)Math.round! jmat [1] [5] *1000) /lOOOf ) ) 
textFieldSl .setText !Float. toString! ! float ) Math . round! jmat [2 ] [0] *1000) /lOOOf ) ) 
textField32 . setText ! Float . toString ! ! f loat ) Math. round ! jmat [2] [l]*1000)/1000f)) 
textField33 .setText ! Float .toString! I float)Math.round! jmat [2] [2] *1000) /lOOOf)) 
textField34.setText!Float. toString! I float ) Math. round! jmat [2 ] [3 ] *1000) /lOOOf ) ) 
textField35 . setText ! Float . toString ! ! float )Math. round ! jmat [2 ] [4]*1000)/1000f) ) 
textField36.setText!Float. toString! ! float ) Math. round ! jmat [2 ] [5] *1000) /lOOOf) ) 
textField41 . setText ! Float . toString ! ! float ) Math. round! jmat [3 ) [0]*1000)/1000f)) 
textField42 . setText !Float . toString ! !float)Math.round! jmat [3) (11*1000) /lOOOf) ) 
textField43 . setText !Float . toString ! ! float )Math. round (jmat [3 ) [2] *1000) /lOOOf) ) 
textField44 .setText (Float . toString ! ! float )Math. round (jmat [3 ] [3] *1000) /lOOOf)) 
textFieldlS . setText (Float . toString ! ! float) Math. round (jmat [3] (4]*1000)/1000f) ) 
textField46. setText (Float. toString! ! float )Math. round (jmat [3 ] [5] *1000) /lOOOf) ) 
textFieldSl. setText (Float. toString! ! float )Math. round (jmat [4 ] [0] *1000) /lOOOf ) ) 
textFieldS2 . setText (Float . toString ! ! float ) Math. round! jmat [4] (l]*1000)/1000f)) 
textFieldSl .setText (Float .toString! ( float ) Math. round ( jmat [ 4 ] [2) *1000) /lOOOf) ) 
textFieldSl .setText (Float . toString ! ( float )Math. round ( jmat [4 ] [3] *1000) /lOOOf ) ) 
textFieldSS.setText (Float. toString! ( float ) Math. round ( jmat [4 ] [4] *1000) /lOOOf ) ) 
textFieldSe .setText (Float .toString! ! float ) Math. round ( jmat [4 ] (S) *1000) /lOOOf ) ) 
textFieldSl .setText (Float . toString ( ( float )Math. round ( jmat [ S] [0] *1000) /lOOOf ) ) 
textField62 .setText (Float .toString! ( float) Math. round ( jmat [ 5 1 (1) *1000) /lOOOf)) 
textField63 .setText (Float . toString ( ( float) Math. round! jmat [5] [2] *1000) /lOOOf ) ) 
textField64 .setText (Float. toString! ( float ) Math . round ( jmat [ 5 ] [3] *1000) /lOOOf)) 
textFieldSS . setText (Float . toString ( ( float ) Math. round! jmat [ 5] [4] *1000) /lOOOf)) 
textFieldSS.setText (Float. toString! ! float ) Math . round ! jmat [ 5 1 [S] *1000) /lOOOf) ) 
textField_det. setText (Float. toString! ( float ) Math. round (det j *1000) /lOOOf) ) ; 

// textField_det . setText ( "N/A" ) ; 
if  (qi  >=  O.Of) 

textField_qi .setText (Float . toString ( ( float ) Math . round (qi* 1000 ) /lOOOf) ) ; 
else  textField_qi . setText ! "N/A" ) ; 


void  jblnit!)  throws  Exception 

{ 

panell . setLayout (xYLayoutl ) ; 
xYLayoutl . setHeight (258 ) ; 
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xYLayoutl . setwidth (509 ) ; 
textFieldll . setEditable  ( false) 
textFieldl2 . setEditable ( false) ; 
textFieldll . setEditable ( false) ; 
textFieldl4 . setEditable ( false) ; 
textFieldlS . setEditable ( false) ; 
textFieldie . setEditable ( false) ; 
textField21 . setEditable ( false) ; 
textField22 . setEditable ( false) ; 
textField23 . setEditable ( false) ; 
textField24 . setEditable ( false) ; 
textField25 . setEditable ( false) ; 
textField26 . setEditable ( false) ; 
textFieldll . setEditable ( false) ; 
textFieldl2 . setEditable ( false) ; 
textFieldll . setEditable ( false) ; 
textFieldl4 . setEditable ( false) ; 
textFieldlB . setEditable ( false) ; 
textFieldie . setEditable ( false) ; 
textField41 . setEditable ( false) ; 
textField42 . setEditable ( false) ; 
textField43 . setEditable ( false) ; 
textField44 . setEditable ( false) ; 
textField45 . setEditable ( false) ; 
textField46 . setEditable (false) ; 
textFieldSl . setEditable ( false) ; 
textField52 . setEditable (false) ; 
textFieldSl . setEditable  (false) 
textField54 . setEditable (false) ; 
textField55 . setEditable (false) ; 
textFieldSS . setEditable ( false) ; 
textFieldei . setEditable ( false) ; 
textField62 . setEditable ( false)  ; 
textFieldSl . setEditable ( false) ; 
textFieldS4 . setEditable ( false) ; 
textFieldSS . setEditable ( false) ; 
textFieldSS . setEditable ( false) ; 
labell . setAlignment (1); 
labell . setText ( "Determimant  of  J" ) ; 
textField_det . setEditable ( false)  ; 
textField_qi . setEditable ( false) ; 
label2 . setText ( "Quality  Index" ) ; 
label2  . setAlignment  (1) 
olc_button.  setName  ( "OK"  ) ; 
ol<_button.  setLabel  ( "OK" ) ; 

o)c_button . addActionListener  (new  j ava . awt . event . ActionListener  ( ) 
{ 


public  void  actionPerformed(ActionEvent  e) 
{ 

o)t_button_actionPerformed(e)  ; 


} 

}); 

panell.add(textField21,  new 
panell . add ( textField22 , new 
panell . add ( textField23 , new 
panell . add ( textField24 , new 
panell . add ( textField2 5 , new 
panell . add ( textField2 6 , new 
panell. add (textFieldll,  new 
panell . add ( textFieldl2 , new 
panell . add ( textFieldll , new 
panell . add ( textFieldl4 , new 
panell . add ( textFieldlB , new 
panell . add ( textFieldlS , new 
panell . add ( textField41 , new 
panell . add ( textField42 , new 
panell . add(textField41 , new 
panell . add ( textField44 , new 
panell . add ( textField4 5 , new 
panell . add ( textField4S , new 


XYConstraints (11 , 42,  77,  -1)); 
XYConstraints(94,  42,  77,  -1)); 
XYConstraints ( 175 , 42,  77,  -1)) 
XYConstraints (256 , 42,  77,  -1)) 
XYConstraints (117,  42,  77,  -1)) 
XYConstraints ( 418 , 42,  77,  -1)) 
XYConstraints ( 11 , 69,  77,  -1)); 
XYConstraints (94,  69,  77,  -1)); 
XYConstraints (175,  69,  77,  -1)) 
XYConstraints (256,  69,  77,  -1)) 
XYConstraints (337,  69,  77,  -1)) 
XYConstraints (418 , 69,  77,  -1)) 
XYConstraints ( 13 , 97,  77,  -1)); 
XYConstraints (94,  97,  77,  -1)); 
XYConstraints (175,  97,  77,  -1)) 
XYConstraints ( 256 , 97,  77,  -1)) 
XYConstraints (337,  97,  77,  -1)) 
XYConstraints (418,  97,  77,  -1)) 
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panell . add ( textFieldSl , 
panell . add ( textField52  , 
panell . add ( textField53 , 
panell . add ( textField54  , 
panell . add ( textField55 , 
panell . add ( textField56 , 
panell . add ( textField61 , 
panell . add ( textField62  , 
panell . add ( textField63 , 
panell . add ( textField64  , 
panell . add ( textField65 , 
panell . add ( textField66 , 
panell . add ( textFieldl6 , 
panell . add ( textFieldll , 
panell . add ( textFieldl2 , 
panell . add ( textFieldl3 , 
panell . add ( textFieldl4 , 
panell . add ( textFieldlS , 
panell . add ( label2 , new 
panell . add ( textField_qi , new  XYConstraints (418 , 184,  77,  22) 
panell .add (textField_det,  new  XYConstraints (175,  186,  77,  22 
panell . add( labell , new  XYConstraints (13 , 183,  142,  25)); 
panell  .add  (o)c_but  ton,  new  XYConstraints  (193,  221,  124,  24)); 


new 

XYConstraints 

13, 

124,  77, 

-1)  ) ; 

new 

XYConstraints ( 94 , 

124,  77, 

-1)  ) ; 

new 

XYConstraints ( 175 , 

124,  77 

-l)  ) ; 

new 

XYConstraints 

256, 

124,  77 

-1)  ) ; 

new 

XYConstraints (337 , 

124,  77 

-l)  ) ; 

new 

XYConstraints (418, 

124,  77, 

-1)  ) ; 

new 

XYConstraints ( 13 , 

152,  77, 

-l)  ) ; 

new 

XYConstraints ( 94 , 

152,  77, 

-1)  ) ; 

new 

XYConstraints 

175, 

152,  77, 

-l)  ) ; 

new 

XYConstraints 

256, 

152,  77, 

-1)  ) ; 

new 

XYConstraints 

337, 

152,  77, 

-l)  ) ; 

new 

XYConstraints 

418, 

152,  77, 

-1)  ) ; 

new 

XYConstraints 

418, 

14,  77, 

-l)  ) ; 

new 

XYConstraints ( 13 , 

14,  77, 

1)  ) ; 

new 

XYConstraints 

94, 

14,  77, 

1)  ) ; 

new 

XYConstraints 

175, 

14,  77, 

-1)  ) ; 

new 

XYConstraints 

256, 

14,  77, 

-1)  ) ; 

new 

XYConstraints (337 , 

14,  77, 

-1)  ) ; 

XYConstraints (256, 

184, 

144,  25)); 

protected  void  processWindowEvent (WindowEvent  e) 
{ 

if(e.getID()  ==  WindowEvent .WINDOW_CLOSING) 

{ 

cancel ( ) ; 

} 

super .processWindowEvent (e) ; 

) 

void  cancel ( ) 

{ 

dispose ( ) ; 

) 

void  ok_button_actionPerformed(ActionEvent  e) 

{ 

dispose ( ) ; 

) 


) 


4.  PLATFORM.JAVA 


//Title:  VRML  Platform 

//Copyright:  Copyright  (c)  2000 

//Author:  Jaehoon  Lee 

pacltage  Platform; 

import  java.net.*; 

import  java.io.*; 

import  j ava . awt . * ; 

import  j ava . awt . event . * ; 

import  java. applet .* ; 

import  vrml . external . field .* ; 

import  vrml . external . exception. * ; 

import  vrml .external .Node; 

import  vrml . external . Browser ; 

import  com. bor land. jbcl . layout . * ; 

/**************************************************** ^ 
/*  Main  class  for  the  platform  project  */ 
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^****************************************************^ 

public  class  Platform  extends  Applet 

{ 

Node  xfplatform  = null; 

Node  xf script  = null; 

Node [ 1 legnodes  = new  Node[12]; 

EventInSFRotation  rot  = null; 

EventInSFRotation  iprot  = null; 

EventOutSFRotation  oprot  = null; 

EventInSFVecSf  trn  = null; 

EventInSFVec3f  rst  = null; 

EventInSFFloat  stt  = null; 

EventInSFFloat  stb  = null; 

EventInSFVec3f  sht  = null; 

EventInSFVec3f  shb  = null; 

EventInSFBool  set  = null; 

EventInSFBool  seb  = null; 

EventInSFBool  ecle  = null; 

float  p_incmt  = l.Of; 
float  a_incmt  = 10. Of; 

Browser  vrmlbrowser  = null; 

XYLayout  xYLayoutl  = new  XYLayout ( ) ; 
boolean  isStandalone  = false; 

Button  txminus  = new  Button ( ) ; 

Button  txplus  = new  ButtonO; 

Button  tyminus  = new  Button(); 

Button  typlus  = new  ButtonO; 

Button  tzminus  = new  Button(); 

Button  tzplus  = new  Button(); 

Button  rxplus  = new  Button(); 

Button  rxminus  = new  Button(); 

Button  ryminus  = new  Button(); 

Button  ryplus  = new  Button(); 

Button  rzminus  = new  Button(); 

Button  rzplus  = new  Button(); 

Button  configuration  = new  Button(); 

TextField  ty  = new  TextField(); 

TextField  tx  = new  TextField(); 

TextField  tz  = new  TextField(); 

TextField  p_inc  = new  TextFieldO; 

TextField  rxz  = new  TextField(); 

TextField  rxy  = new  TextField(); 

TextField  rxx  = new  TextFieldO; 

TextField  rxa  = new  TextField(); 

TextField  a_inc  = new  TextField(); 

Label  labell  = new  Label () ; 

Label  label2  = new  Label {) ; 

Label  label3  = new  Label  ( ) ; 

Label  label6  = new  Label ( ) ; 

Label  labelV  = new  Label ( ) ; 

Label  labels  = new  Labell); 

Label  label9  = new  Label!); 

Label  labellO  = new  Labell); 

Label  labelll  = new  Labell); 

Label  label4  = new  Labell); 

Button  buttonl5  = new  ButtonI); 

Label  labels  = new  Labell); 

Label  labell2  = new  Labell); 

Button  jacobian  = new  ButtonI); 

Button  reserved  = new  Button  I ) ; 
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Button  motion_reset  = new  Button!); 

Config_data  pdata  = new  Conf ig_data ( ) ; 

Checltbox  checlcboxl  = new  Chec)tbox  ( ) ; 

JB_Dialog  Djacobian  = null; 

Conf ig_Dialog  config  = null; 

//Construct  the  applet 
public  Platform!) 

{ 

float []  initpos  = {O.Of,  O.Of,  15.0f); 

pdata . setTopShape I "Triangle” ) ; 

pdata . setBaseShape ! "Triangle" ) ; 

pdata . setTopSeparation ! "Along  Both  Edges"); 

pdata . setBaseSeparation ! "Along  Both  Edges"); 

pdata . setTopSize ! 15 . Of ) ; 

pdata . setBaseSize 1 30 . Of ) ; 

pdata . set Alpha  ! 0 . 0 f ) ; 

pdata . setBeta  !0 . Of ) ; 

pdata . setMaxpos ! initpos) ; 

) 

//Initialize  the  applet 

public  void  initi) 

{ 

try 

{ 

jblnit ! ) ; 

) 

catch  !Exception  e) 

{ 

e .printStacltTrace  I ) ; 

) 

tx .  setText ! Float . toString !pdata . getMaxpos I ) [ 0 ] ) ) ; 

ty .  setText I Float . toString !pdata . getMaxpos I ) ( 1 ] ) ) ; 

tz .  setText I Float . toString !pdata. getMaxpos ! ) [2] ) ) ; 

rxx.  setText I Float . toString lO.Of)); 

rxy.  setText I Float . toString 10 . Of ) ) ; 

rxz.  setText IFloat. toString II. Of ) ) ; 
rxa . setText IFloat . toString lO.Of)); 
p_inc . setText IFloat . toString lp_incmt) ) ; 
a_inc . setText IFloat . toString I a_incmt) ) ; 


private  void  jblnit I)  throws  Exception 

{ 

xYLayoutl . setWidth 1250 ) ; 
xYLayoutl . setHeight 1520) ; 

txminus . setFont Inew  Font  I "Dialog" , 1,  20)); 
txminus . setLabel  I " - " ) ; 

txminus . addActionListener  Inew  java . awt . event . ActionListener  I ) 

{ 

public  void  actionPerf ormed I ActionEvent  e) 

{ 

txminus_actionPerformed|e)  ; 

} 

)); 

txplus . setFont Inew  Font  I "Dialog" , 1,  20)); 
txplus . setLabel I " + " ) ; 

txplus . addActionListener Inew  java . awt .event .ActionListener I ) 

{ 

public  void  actionPerf ormed I ActionEvent  e) 

{ 

txplus_actionPerformed|e) ; 

} 

))  ; 


84 


tyminus  . setFont  (new  Font  ( ''Dialog” , 1,  20)); 
tyminus . setLabel ("-"); 

tyminus . addActionListener (new  java . awt . event . ActionListener ( ) 

( 

public  void  actionPerf ormed ( ActionEvent  e) 

{ 

tyminus_actionPerformed(e) ; 

} 

})  ; 

typlus . setFont (new  Font ( "Dialog" , 1,  20)); 
typlus . setLabel ("+"); 

typlus . addActionListener (new  java . awt .event .ActionListener ( ) 

{ 

public  void  actionPerf ormed (ActionEvent  e) 

{ 

typlus_actionPerformed(e) ; 

) 

))  ; 

tzminus . setFont (new  Font ( "Dialog" , 1,  20)); 
tzminus . setLabel ("-"); 

tzminus . addActionListener (new  java . awt . event .ActionListener ( ) 

{ 

public  void  actionPerformed (ActionEvent  e) 

{ 

tzminus_actionPerformed(e) ; 

) 

})  ; 

tzplus . setFont (new  Font ( "Dialog" , 1,  20)); 
tzplus . setLabel ("+”); 

tzplus . addActionListener (new  java. awt . event .ActionListener ( ) 

{ 

public  void  actionPerformed(ActionEvent  e) 

{ 

tzplus_actionPerformed(e) ; 

} 

})  ; 

rxplus . setFont (new  Font ( "Dialog" , 1,  20)); 
rxplus . setLabel ("+”); 

rxplus . addActionListener (new  java . awt .event .ActionListener ( ) 

{ 

public  void  actionPerf ormed (ActionEvent  e) 

{ 

rxplus_actionPerformed(e) ; 

} 

}); 

rxminus . setFont (new  Font ( "Dialog" , 1,  20)); 
rxminus . setLabel ("-"); 

rxminus . addActionListener (new  java . awt . event .ActionListener ( ) 

{ 

public  void  actionPerformed (ActionEvent  e) 

{ 

rxminus_actionPerformed(e) ; 

} 

}); 

ryminus . setFont (new  Font ( "Dialog" , 1,  20)); 
ryminus . setLabel ("-"); 

ryminus . addActionListener (new  java . awt . event .ActionListener ( ) 

{ 

public  void  actionPerformed (ActionEvent  e) 

{ 

ryminus_actionPerformed(e) ; 


})  ; 

ryplus . setFont (new  Font ( "Dialog" , 1,  20)); 
ryplus . setLabel ( " + ” ) ; 

ryplus . addActionListener (new  java . awt . event .ActionListener ( ) 

{ 

public  void  actionPerf ormed (ActionEvent  e) 

( 

ryplus_actionPerformed (e) ; 

) 
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}); 

rzminus . setFont (new  Font ( "Dialog” , 1,  20)); 
rzminus . setLabel ("-"); 

rzminus . addActionListener (new  java . awt . event .Act ionListener ( ) 

{ 

public  void  actionPerformed (ActionEvent  e) 

{ 

rzminus_actionPerformed(e) ; 

} 

)); 

rzplus . setFont (new  Font ( "Dialog” , 1,  20)); 
r zplus . setLabel ("+”); 

rzplus . addActionListener (new  java . awt . event .Act ionListener ( ) 

{ 

public  void  actionPerformed (ActionEvent  e) 

{ 

rzplus_actionPerformed(e) ; 

) 

})  ; 

configuration . setLabel ( "Configuration" ) ; 

configuration . addActionListener (new  java. awt . event .Act ionListener ( ) 

{ 

public  void  actionPerformed (ActionEvent  e) 

{ 

conf iguration_actionPerf ormed(e) ; 

} 

})  ; 

ty . setText  ( ” textFieldl " ) 

ty .  addActionListener (new  java . awt . event .Act ionListener ( ) 

{ 

public  void  actionPerformed (ActionEvent  e) 

{ 

ty_actionPerformed(e) ; 

} 

})  ; 

tx . setText ( ” textFieldl " ) ; 

tx . addActionListener (new  java . awt . event .Act ionListener ( ) 

{ 

public  void  actionPerformed (ActionEvent  e) 

{ 

tx_actionPerformed(e) ; 

) 

))  ; 

tz .  setText ( " textFieldl " ) ; 

tz . addActionListener (new  java . awt . event .Act ionListener ( ) 

{ 

public  void  actionPerformed (ActionEvent  e) 

{ 

tz_actionPerformed(e) ; 

) 

))  ; 

p_inc . setText ( ” textFieldl ” ) ; 

p_inc . addActionListener (new  java . awt . event .Act ionListener ( ) 

{ 

public  void  actionPerformed (ActionEvent  e) 

{ 

p_inc_actionPerformed(e) ; 

) 

))  ; 

rxz . setText ( " textFieldl ” ) ; 

rxz . addActionListener (new  java. awt . event . Act ionListener ( ) 

{ 

public  void  actionPerformed (ActionEvent  e) 

{ 

rxz_actionPerformed(e) ; 

} 

))  ; 

rxy . setText ( ” textFieldl " ) ; 

rxy . addActionListener (new  java . awt . event .Act ionListener ( ) 

{ 

public  void  actionPerformed (ActionEvent  e) 
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{ 

rxy_actionPerformed (e) ; 

} 

})  ; 

rxx . setText ( " textFieldl " ) ; 

rxx . addActionListener (new  java . awt . event . ActionListener ( ) 

{ 

public  void  actionPerformed ( ActionEvent  e) 

{ 

rxx_actionPerformed (e) ; 

} 

})  ; 

rxa . setText ( " textFieldl " ) ; 

rxa . addActionListener (new  java . awt . event .ActionListener ( ) 

{ 

public  void  actionPerformed (ActionEvent  e) 

{ 

rxa_actionPerf ormed ( e) ; 

} 

))  ; 

a_inc . setText ( " textFieldl " ) ; 

a_inc . addActionListener (new  java . awt . event .ActionListener ( ) 

{ 

public  void  actionPerformed(ActionEvent  e) 

{ 

a_inc_actionPerformed(e) ; 

} 

) ) ; 

labell . setFont (new  Font ( "Dialog” , 1,  18)); 
labell . setAlignment ( 1 ) ; 
labell . setText ( "X” ) ; 

label2 . setFont (new  Font ( "Dialog” , 1,  18)); 
label2 . setAlignment ( 1 ) ; 
label 2 . setText ( "Y” ) ; 

labell . setFont (new  Font ( "Dialog" , 1,  18)); 

labell . setAlignment ( 1 ) ; 

labell . setText ( " Z” ) ; 

labels . setAlignment ( 1 ) ; 

labels . setText ( "Axis" ) ; 

label? . setAlignment ( 1 ) ; 

label? . setText ( "Angle  (Degree) " ) ; 

labels . setAlignment ( 1 ) ; 

labels . setText ( "X-axis  Rotation" ) ; 

label9 . setAlignment ( 1 ) ; 

label9 . setText ( "Y-axis  Rotation” ) ; 

labellO . setAlignment ( 1 ) ; 

labellO . setText ( " Z-axis  Rotation" ) ; 

labelll . setAlignment (1); 

labelll . setText ( "Angle  Increament") ; 

label 4 . setForeground (Color .blue) ; 

label4 . setAlignment ( 1 ) ; 

label4 . setFont (new  java . awt . Font (" Serif " , 1,  20)); 
label4 . setText ( "Translation" ) ; 
buttonlS . setLabel ( "buttonl " ) ; 
labels . setForeground (Color .blue) ; 

labels . setFont (new  java . awt . Font (" Serif " , 1,  20)); 

labels . setAlignment ( 1 ) ; 

labels . setText ( "Rotation" ) ; 

labell2 . setAlignment ( 1 ) ; 

label 12 . setText (" Position  Increament" ) ; 

jacobian. setLabel ( "Jacobian  Matrix") ; 

jacobian . addActionListener (new  java . awt . event .ActionListener ( ) 

{ 

public  void  actionPerformed (ActionEvent  e) 

{ 

jacobian_actionPerformed(e) ; 

) 

} ) ; 

this . setLayout (xYLayoutl ) ; 
reserved. setLabel ( "Get  DetJm"); 

reserved. addActionListener (new  java . awt . event .ActionListener ( ) 
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{ 


public  void  actionPerformed ( ActionEvent  e) 

{ 

reserved_actionPerformed(e) ; 

) 

))  ; 

motion_reset . setLabel ( "Motion  Reset" ) ; 
checkboxl . setLabel ( "Enable  Connector  Length  Change"); 
checkboxl . addItemListener (new  java . awt . event . ItemListener ( ) 
{ 


public  void  itemStateChanged ( ItemEvent  e) 

{ 

checkboxl_itemStateCheinged(e)  ; 

) 

}); 

this . add (rzplus,  new  XYConstraints (187,  284,  49,  24)); 
this . add (rzminus,  new  XYConstraints (126,  284,  49,  24)); 
this . add (ryplus,  new  XYConstraints (187,  256,  49,  24)); 
this. add (ryminus,  new  XYConstraints (126,  256,  49,  24)); 
this . add (rxminus,  new  XYConstraints (126,  228,  49,  24)); 
this . add (rxplus,  new  XYConstraints ( 187 , 228,  49,  24)); 
this. add (tzplus,  new  XYConstraints ( 183 , 89,  53,  24)); 
this . add ( tzminus,  new  XYConstraints ( 52 , 89,  53,  24)); 
this  . add  ( typlus,  new  XYConstraints  (183  , 62,  53,  24)),- 
this  . add  ( tyminus,  new  XYConstraints  ( 52 , 62,  53,  24)),- 
this  . add  ( txplus,  new  XYConstraints  ( 183  , 34,  53,  24)),- 
this . add ( txminus,  new  XYConstraints ( 52 , 34,  53,  24)); 
this.add(tx,  new  XYConstraints  ( 111 , 34,  65,  24)),- 
this.add(a_inc,  new  XYConstraints  (171,  311,  65,  24)),- 
this.add(rxa,  new  XYConstraints  ( 145 , 200,  91,  24)),- 
this . add(rxx,  new  XYConstraints  (41 , 171,  63,  24)),- 
this  . add  (rxy,  new  XYConstraints  ( 107 , 171,  63,  24)),- 
this  . add  (rxz , new  XYConstraints  ( 173  , 171,  63,  24)),- 
this  . add  (p_inc , new  XYConstraints  ( 171 , 117,  65,  24)),- 
this.add(tz,  new  XYConstraints  ( 111 , 89,  65,  24)),- 
this.add(ty,  new  XYConstraints  { 111 , 62,  65,  24)),- 
this  . add  ( label6 , new  XYConstraints  (9,  171,  33,  24)),- 
this  . add  ( labels  , new  XYConstraints  ( 10 , 89,  27,  24)),- 
this  . add  ( label2  , new  XYConstraints  (10,  62,  27,  24)),- 
this  . add( labell , new  XYConstraints  ( 10 , 34,  27,  24)),- 
this  . add(  labell2  , new  XYConstraints  (10,  117,  154,  24)),- 
this.adddabelll,  new  XYConstraints  ( 10 , 311,  154,  24)),- 
this  . add(  label7 , new  XYConstraints  (10,  200,  124,  24)),- 
this  . add(  labellO , new  XYConstraints  ( 10 , 284,  104,  24)),- 
this  . add(  label9,  new  XYConstraints  ( 10 , 256,  104,  24)),- 
this  . add(  label8 , new  XYConstraints  ( 10 , 228,  104,  24)),- 
this  . add(  label4  , new  XYConstraints  ( 10 , 6,  226,  24)),- 
this  . add(buttonl5,  new  XYConstraints  ( 428 , 285,  38,  24)),- 
this  . add ( labels,  new  XYConstraints  ( 10 , 145,  225,  24)),- 
this  . add  (motion_reset , new  XYConstraints  (10,  341,  226,  24)),- 
this  . add  (configuration,  new  XYConstraints  (10  , 388,  226,  24)),- 
this  . add  ( jacobian,  new  XYConstraints  (10,  418,  226,  24)),- 
this.  add  (reserved,  new  XYConstraints  (10,  448,  226,  24)),- 
this . add  (chec)cboxl , new  XYConstraints  ( 10 , 488,  226,  24)),- 
motion_reset . addActionListener (new  java . awt . event . ActionListener ( ) 
{ 

public  void  actionPerformed (ActionEvent  e) 

{ 

motion_reset_actionPerf ormed (e)  ,- 

} 

))  ; 


public  void  start () 

{ 

//  getting  the  VRML  browser 
vrmlbrowser  = Browser  . getBrowser  ( this)  ,- 
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try  { 

//  establish  the  connection  between  VRML  and  Java  applet 
xfscript  = vrmlbrowser . getNode ( " EAI_CONTROL” ) ; 
xfplatform  = vrmlbrowser . getNode ( "TOP_PLATFORM" ) ; 
for  (int  i=0;  i<6;  i++) 

{ 

legnodes [i ] = vrmlbrowser .getNode ( “T_LEG" + Integer . toString ( i+1 ) ) ; 
legnodes  [ i + 6 1 = vrinlbrowser . getNode  { "B_LEG" +Integer.  toString  ( i + 1 ) ) ; 

) 

trn  = (EventlnSFVeclf ) xfscript . getEventIn (" set_translation" ) ; 

rot  = (EventInSFRotation)  xfscript . getEventIn  ("  set_rotation" ) ,- 

rst  = (EventInSFVecBf ) xfscript .getEventIn (" set_motion_reset ") ; 

stt  = (EventInSFFloat)  xfscript . getEventIn  ('' set_triangular_top_set ")  ; 

stb  = (EventInSFFloat)  xfscript . getEventIn (" set_triangular_base_set ") ; 

sht  = (EventlnSFVeclf ) xfscript .getEventIn (" set_hexagonal_top_set ") ; 

shb  = (EventlnSFVeclf ) xfscript . getEventIn (" set_hexagonal_base_set ") ; 

set  = ( Event InSFBool ) xfscript . getEventIn (" set_custom_top_set ") ; 

seb  = (EventInSFBool ) xfscript . getEventIn (" set_custom_base_set ") ; 

iprot  = (EventInSFRotation)  xfplatform. getEventIn (" set_rotation" ) ; 

oprot  = (EventOutSFRotation)  xfplatform.  getEventOut  ('' rotation_changed" ) 

ecle  = (EventInSFBool)  xfscript . getEventIn (" set_connector_length" ) ; 

stt . setValue (pdata. getTopSize ( ) ) ; 

stb. setValue (pdata . getBaseSize ( ) ) ; 

rst . setValue (pdata . getMaxpos ( ) ) ; 

ecle . setValue (checkboxl . getState ( ) ) ; 

) 

catch  (InvalidNodeException  ne)  { 

System. out .println (" PROBLEMS ! : " + ne)  ; 

} 

catch  ( InvalidEventInException  ee)  { 

System. out .println (" PROBLEMS ! : " + ee) ; 

} 

catch  ( InvalidEventOutException  ee)  { 

System. out .println (" PROBLEMS ! : ” + ee) ; 


/ /Get  Applet  information 

public  String  getAppletInfo ( ) 

{ 

return  "Applet  Information" ; 

} 

//Get  parameter  info 

public  StringUn  getParameterInf o ( ) 

{ 

return  null; 

} 

//  event  handler  for  -x  translation  button 
void  txminus_actionPerf ormed ( ActionEvent  e) 
{ 

float [)  tval=  new  float[3); 
float  X, y, z ; 

Float  j Float; 

jFloat=Float.valueOf (tx.getText ( ) ) ; 

x= jFloat . f loatValue ( ) ; 

jFloat=Float . valueOf ( ty .getText ( ) ) ; 

y= jFloat . f loatValue ( ) ; 

jFloat=Float . valueOf ( tz . getText ( ) ) ; 

z=jFloat . f loatValue ( ) ; 

tval [ 0 ] =x-p_incmt ; 

tval [ 1 ] =y; 

tval [2] =z; 

trn . setValue ( tval ) ; 

tx . setText (Float . toString ( tval [ 0] ) ) ; 


89 


//  event  handler  for  -y  translation  button 
void  tyminus_actionPerformed(ActionEvent  e) 
{ 

float []  tval=  new  float [3]; 
float  X, y , z ; 

Float  jFloat; 

jFloat=Float .valueOf (tx.getText ( ) ) ; 

x= jFloat . f loatValue ( ) ; 

jFloat=Float .valueOf (ty.getText ( ) ) ; 

y=jFloat . f loatValue ( ) ; 

jFloat=Float .valueOf ( tz . getText ( ) ) ; 

z= jFloat . f loatValue ( ) ; 

tval [0 ] =x; 

tval [ 1 J =y-p_incmt ; 

tval [2] =z ; 

trn . setValue ( tval ) ; 

ty . setText (Float . toString ( tval [ 1 ] ) ) ; 

) 

//  event  handler  for  +y  translation  button 
void  typlus_actionPerformed(ActionEvent  e) 

{ 

float []  tval=  new  float[3]; 

Float  jFloat; 
float  X, y, z ; 

jFloat=Float .valueOf (tx.getText ( ) ) ; 

x=jFloat . f loatValue ( ) ; 

jFloat=Float .valueOf (ty.getText ( ) ) ; 

y= jFloat . f loatValue ( ) ; 

jFloat=Float .valueOf (tz .getText ( ) ) ; 

z=jFloat . f loatValue ( ) ; 

tval [0] =x; 

tval [ 1 1 =y+p_incmt ; 

tval [2] =z ; 

trn . setValue ( tval ) ; 

ty. setText (Float . toString ( tval [1] ) ) ; 

} 

//  event  handler  for  +x  translation  button 
void  txplus_actionPerf ormed (ActionEvent  e) 

{ 

float [)  tval=  new  float[3]; 

Float  jFloat; 
float  X, y , z ; 

jFloat=Float .valueOf (tx.getText ( ) ) ; 

x=jFloat . f loatValue ( ) ; 

j FI oat =Float .valueOf ( ty.getText ( ) ) ; 

y= jFloat . f loatValue ( ) ; 

jFloat=Float .valueOf ( tz .getText ( ) ) ; 

z=jFloat . f loatValue ( ) ; 

tval ( 0 ] =x+p_incmt ; 

tval [1 1 =y ; 

tval [2] =z; 

trn . setValue ( tval ) ; 

tx . setText (Float . toString ( tval [0] ) ) ; 

) 

//  event  handler  for  +z  translation  button 
void  tzplus_actionPerformed(ActionEvent  e) 

{ 

float [J  tval=  new  float [3]; 

Float  jFloat; 
float  x,y,z; 

jFloat=Fl oat .valueOf (tx.getText ( ) ) ; 
x= jFloat . f loatValue ( ) ; 
jFloat=Float .valueOf ( ty.getText ( ) ) ; 
y= jFloat . f loatValue ( ) ; 
jFloat=Float .valueOf ( tz .getText ( ) ) ; 
z= jFloat . f loatValue ( ) ; 
tval [0] =x; 
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tval [ 1 ) =y ; 

tval [ 2 ] =z+p_incmt ; 

trn . setValue ( tval ) ; 

tz . setText (Float . toString ( tval [2 ] ) ) ; 

} 

//  event  handler  for  -z  translation  button 
void  tzminus_actionPerformed(ActionEvent  e) 
{ 

float []  tval=  new  float(3]; 

Float  jFloat; 
float  x,y,z; 

jFloat=Float . valueOf ( tx. getText ( ) ) ; 

x= jFloat . f loatValue ( ) ; 

jFloat=Float . valueOf ( ty. getText { ) ) ; 

y= jFloat . f loatValue ( ) ; 

jFloat=Float .valueOf ( tz . getText ( ) ) ; 

z=jFloat . f loatValue ( ) ; 

tval [0] =x; 

tval [IJ  =y; 

tval [2] =z-p_incmt; 

trn . setValue ( tval ) ; 

tz . setText (Float . toString ( tval [2 ] ) ) ; 

) 

//  event  handler  for  x translation  textbox 
void  tx_actionPerf orined ( ActionEvent  e) 

{ 

float (]  tval=  new  float [3]; 

Float  jFloat; 
float  x,y, z; 

jFloat=Float. valueOf (tx. getText ( ) ) ; 

x= jFloat . f loatValue ( ) ; 

jFloat=Float .valueOf ( ty. getText ( ) ) ; 

y= jFloat . f loatValue ( ) ; 

jFloat=Float. valueOf (tz .getText ( ) ) ; 

z= jFloat . f loatValue ( ) ; 

tval [0] =x; 

tval [1 ) =y; 

tval [2] =z; 

trn . setValue ( tval ) ; 

) 

/ / event  handler  for  y translation  textbox 
void  ty_actionPerformed(ActionEvent  e) 

{ 

float [1  tval=  new  float[3]; 

Float  j Float ; 
float  x,y,z; 

jFloat=Float .valueOf ( tx . getText ( ) ) ; 

x= jFloat . f loatValue  ( ) 

jFloat=Float .valueOf (ty. getText ( ) ) ; 

y= jFloat . f loatValue ( ) ; 

jFloat=Float .valueOf ( tz . getText ( ) ) ; 

z= jFloat . f loatValue ( ) ; 

tval [ 0 ) =x; 

tval [ 1 ] =y; 

tval [2 ] =z ; 

tm . setValue  ( tval ) ; 

} 

/ / event  handler  for  z translation  textbox 
void  tz_actionPerformed (ActionEvent  e) 

{ 

float []  tval=  new  float [3]; 

Float  jFloat; 
float  x,y, z; 

jFloat=Fl oat .valueOf ( tx . getText ( ) ) ; 
x= jFloat . f loatValue ( ) ; 
jFloat=Float .valueOf ( ty. getText ( ) ) ; 
y=jFloat . f loatValue ( ) ; 
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jFloat=Float . valueOf (tz .getText ( ) ) ; 

z= jFloat . f loatValue ( ) ; 

tval [0] =x; 

tval [ 1 1 =y ; 

tval [ 2 ] =z ; 

trn . setValue ( tval ) ; 


//  event  handler  for  translation  increament  value  textbox 
void  p_inc_actionPerformed(ActionEvent  e) 

{ 

Float  jFloat=Float . valueOf (p_inc . getText ( ) ) ; 
p_incmt= jFloat . f loatValue ( ) ; 
if  (p_incmt<0 . 0 ) p_incint  = l . Of  ; 
if  (p_incmt>100 . 0 ) p_incmt=l . Of ; 
p_inc . setText (Float . toString (p_incmt ) ) ; 

) 

//  event  handler  for  rotation  axis  textbox  (x) 
void  rxx_actionPerformed ( ActionEvent  e) 

{ 

float []  rval=  new  float [4]; 

Float  jFloat; 

jFloat=Fl oat .valueOf (rxx .getText { ) ) ; 
rval [ 0 ] = jFloat . f loatValue ( ) ; 
jFloat=Float .valueOf (rxy .getText ( ) ) ; 
rval [ 1 ] = jFloat . f loatValue ( ) ; 
j Float =Float .valueOf (rxz . getText ( ) ) ; 
rval [2 ] = jFloat . f loatValue ( ) ; 
jFloat=Float .valueOf (rxa. getText ( ) ) ; 
rval [3 ] = jFloat . f loatValue ()*0.017453f; 
iprot . setValue ( rval ) ; 
rval=oprot .getValue ( ) ; 
set_rotation_text (rval) ; 

) 

/ / event  handler  for  rotation  axis  textbox  (y) 
void  rxy_actionPerformed (ActionEvent  e) 

{ 

float[]  rval=  new  float[4]; 

Float  jFloat; 

j Fl oat =Float .valueOf ( rxx .getText ( ) ) ; 
rval [ 0 ] = jFloat . f loatValue ( ) ; 
jFloat=Float .valueOf (rxy. getText ( ) ) ; 
rval [1 ] = jFloat . f loatValue ( ) ; 
jFloat=Float .valueOf (rxz .getText ( ) ) ; 
rval [2 ] = jFloat . f loatValue ( ) ; 
j Fl oat =F1 oat .valueOf (rxa .getText () ) ; 
rval [ 3 ] = jFloat . f loatValue ()*0.017453f; 
iprot . setValue ( rval ) ; 
rval=oprot . getValue ( ) ; 
set_rotation_text ( rval ) ; 

) 

//  event  handler  for  rotation  axis  textbox  (z) 
void  rx2_actionPerformed (ActionEvent  e) 

{ 

float []  rval=  new  float [4]; 

Float  jFloat; 

jFloat=Float .valueOf (rxx .getText ( ) ) ; 
rval [0 ] = jFloat . f loatValue ( ) ; 
jFloat=Float .valueOf (rxy .getText ( ) ) ; 
rval [ 1 ] = jFloat . f loatValue ( ) ; 
jFloat=Float .valueOf ( rxz .getText ( ) ) ; 
rval ( 2 ] = jFloat . f loatValue ( ) ; 
jFloat=Float .valueOf (rxa .getText ()); 
rval [3] = jFloat . f loatValue ( ) * 0. 017453 f ; 
iprot . setValue ( rval ) ; 
rval=oprot . getValue ( ) ; 
set_rotation_text (rval ) ; 

) 
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//  event  handler  for  rotation  angle  textbox 
void  rxa_actionPerformed ( ActionEvent  e) 

{ 

float []  rval=  new  float [4]; 

Float  jFloat; 

jFloat= Float . valueOf ( rxx .getText ( ) ) ; 
rval [0] =jFloat . f loatValue ( ) ; 
jFloat=Float . valueOf (rxy .getText ( ) ) ; 
rval [1 ]= jFloat . f loatValue ( ) ; 
j Float =Float .valueOf (rxz . getText ( ) ) ; 
rval [2] =jFloat . f loatValue ( ) ; 
jFloat=Float .valueOf (rxa. getText ( ) ) ; 
rval [3 ] =jFloat . f loatValue ( ) *0 . 017453f ; 
iprot . setValue ( rval ) ; 
rval=oprot . getValue ( ) ; 
set_rotation_text (rval ) ; 

} 

//  event  handler  for  -x  rotation  button 
void  rxminus_actionPerformed(ActionEvent  e) 
{ 

float []  rval=  new  float [4]; 
rval [0] =1 ; 
rval [11=0; 
rval [2)=0; 

rval (3) =-a_incmt*0. 017453 f; 
rot . setValue ( rval ) ; 
rval=oprot . getValue ( ) ; 
set_rotation_text (rval ) ; 

) 

//  event  handler  for  +x  rotation  button 
void  rxplus_actionPerformed (ActionEvent  e) 

{ 

float []  rval=  new  float [4]; 
rval [01=1; 
rval [1] =0 ; 
rval [2 ] =0 ; 

rval [3 ] =a_incmt*0 . 0174 53 f ; 
rot . setValue ( rval ) ; 
rval=oprot . getValue { ) ; 
set_rotation_text (rval ) ; 

} 

//  event  handler  for  +y  rotation  button 
void  ryplus_actionPer formed (ActionEvent  e) 

{ 

float!]  rval=  new  float [4]; 
rval [0] =0; 
rval [1 ] =1 ; 
rval [21=0; 

rval [31 =a_incmt*0 .0174531; 
rot . setValue (rval ) ; 
rval=oprot . getValue ( ) ; 
set_rotation_text (rval ) ; 

) 

//  event  handler  for  +z  rotation  button 
void  rzplus_actionPerformed (ActionEvent  e) 

{ 

float]]  rval=  new  float[4]; 
rval [01=0; 
rval [1 1 =0 ; 
rval [ 2 1 =1 ; 

rval [3 1 =a_incmt*0 . 0174531 ; 
rot . setValue ( rval ) ; 
rval=oprot . getValue ( ) ; 
set_rotation_text (rval ) ; 

} 
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//  setting  data  of  the  rotation  axis  and  angle  textboxes 
void  set_rotation_text ( float [ ] rval ) 

{ 

rxx .  setText {Float . toString ( ( float) Math. ceil ( (double) rval [0]*1000)/1000) ) ; 

rxy .  setText (Float . toString ( ( float ) Math. ceil ( (double) rval [1]*1000)/1000)); 

rxz .  setText (Float . toString ( { float) Math .ceil { (double) rval [2]*1000)/1000)); 

rxa. setText (Float . toString ( { float) Math. ceil { (double) rval [31*57.29578*100) /lOO) ) ; 


//  event  handler  for  rotation  angle  increament  textbox 
void  a_inc_actionPerformed ( ActionEvent  e) 

{ 

Float  jFloat=Float .valueOf (a_inc .getText ( ) ) ; 

a_incmt= jFloat . f loatValue ( ) ; 

if  (a_incmt<0 . 0 ) a_incmt=l . Of ; 

if  (a_incmt>90 . 0 ) a_incmt=l . Of ; 

a_inc . setText (Float . toString (a_incmt) ) ; 

} 


//  event  handler  for  motion  reset  button 
void  motion_reset_actionPerformed(ActionEvent  e) 
{ 


) 


float []  rval  = new  float(4]; 
rst . setValue (pdata.getMaxpos { ) ) ; 

tx .  setText (Float . toString (pdata.getMaxpos { ) [0] ) ) ; 

ty .  setText (Float . toString (pdata.getMaxpos { ) [1 ] ) ) ; 

tz .  setText (Float . toString (pdata . getMaxpos { ) [2])); 

rval [0] =0 . Of ; rval [ 1 ] =0 . Of ; rval [ 2 ] =1 . Of ; rval [ 3 ] =0 . Of ; 
iprot . setValue ( rval ) ; 

rval [0] =1 . Of ; rval [1 1 =0 . Of ; rval [2 ] =0 . Of ; rval [3 ] =pdata .getMaxrot ( ) [0] *0 . 017453f ; 
rot . setValue ( rval ) ; 

rval[01=0.0f;  rval [ 1 ] =1 . Of ; rval [2] =0 . Of ; rval [ 3 ] =pdata .getMaxrot ()  [1 ) *0 . 017453f ; 
rot . setValue ( rval ) ; 


rval [0] =0 . Of ; rval [ 1 ] =0 . Of ; rval [ 2 ] =1 . Of ; rval [ 3 ) =pdata . getMaxrot ()[ 2 ] *0 . 017453 f ; 
rot . setValue ( rval ) ; 
rval=oprot .getValue ( ) ; 
set_rotation_text (rval ) ; 


//  event  handler  for  configuration  button 

void  configuration_actionPerformed (ActionEvent  e) 

{ 

if  (conf ig==null  ||  ! conf ig . isValid ( ) ) 

{ 

config  = new  Conf ig_Dialog (new  Frame (), "Conf iguration" , 

true,  pdata) ; 

config. stt  = stt; 
config. stb  = stb; 
config. sht  = sht; 
config. shb  = shb; 
config. set  = set; 
config. seb  = seb; 


config . show( ) ; 

} 

) 


//  event  handler  for  -y  rotation  button 
void  ryminus_actionPerformed (ActionEvent  e) 
{ 


float (]  rval=  new  float [4]; 
rval [ 0 ] =0 ; 
rval [ 1 ] =1  ; 
rval [2] =0; 

rval ( 3 ] =-a_incmt *0 . 017453  f ; 
rot . setValue ( rval ) ; 
rval=oprot .getValue ( ) ; 

rxx .  setText (Float . toString ( ( float) Math. round (rval [0] *1000) /lOOOf) ) ; 

rxy.  setText (Float . toString { ( float) Math. round (rval [1] *1000) /lOOOf) ) ; 

rxz .  setText (Float . toString ( (float ) Math. round ( rval [2]*1000)/1000f)); 

rxa . setText (Float . toString ( ( float ) Math. round ( rval [3)*57.29578f*1000)/1000f) ) ; 
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//  event  handler  for  -z  rotation  button 
void  rzminus_actionPerf ormed ( ActionEvent  e) 

{ 

float[]  rval=  new  float(4]; 
rval [0]=0; 
rval [1 ] =0 ; 
rval [2)=1; 

rval [3 ] =-a_incmt*0 . 017453f ; 
rot . setValue ( rval ) ; 
rval=oprot . getValue { ) ; 

rxx.  setText (Float . toString ( ( float) Math. round (rval [0]*1000)/1000f) ) ; 

rxy .  setText (Float . toString ( ( float) Math. round (rval [l]*1000)/1000f)); 

rxz .  setText (Float . toString ( ( float ) Math. round (rval [2]*1000)/1000f)); 

rxa . setText (Float . toString ( ( float ) Math. round (rval [3] *57.29578f*1000) /lOOOf) ) ; 

} 

//  event  handler  for  Jacobian  matrix  button 
void  jacobian_actionPerformed(ActionEvent  e) 

{ 

float[][]  jmat;//  6x6  matrix 
float  det j , qi ; 

jmat  = get_jacobian ( ) ; 

detj  = get_determinant ( jmat) ; 

if  (pdata . getMaxdetFound ( ) ) qi  = Math. abs (det j ) /pdata .getMaxdet () ; 
else  qi  = -l.Of; 

// System. out .print In (Djacobian) ; 
if  (Djacobian==null  ||  ! Djacobian . isValid () ) 

{ 

Djacobian  = new  JB_Dialog (new  Frame (), "Jacobian  Matrix", 

true,  jmat,  detj,  qi); 

Djacobian . show ( ) ; 

) 


//  event  handler  for  Get  DetJm  button 
void  reserved_actionPerformed(ActionEvent  e) 

{ 

//  connect  to  the  server 
floatnn  p = new  float [12] [3] ; 
float]] []  q ;//=  new  float [12] [3 ] ; 
float  1; 

float]]  maxpos  = new  float[3]; 
float]]  maxrot  = new  float]3]; 

MessageDialog  message; 

EventOutSFVec3f  gnd  = null; 

String  result,  retval; 

String  messagetext; 

if  (pdata.getMaxdetFound( ) ) 

{ 

messagetext= "The  DetJm  of  the  platform  is  already  calculated."; 

message  = new  MessageDialog (new  Frame (), "Message  Dialog",  true,  messagetext) 

message . show ( ) ; 

return; 

) 

//  generating  unique (unitized)  configuration  data  for  the  platform 

for  (int  i=0;  i<12;  i++) 

{ 

gnd  = (EventOutSFVec3f ) legnodes ] i ] . getEventOut ( " translation_changed" ) ; 
p ] i ] = gnd . getValue ( ) ; 

) 

l=(float)Math.sqrt (p]0] ]0]*p]0]]0]+p]0]]l]*p]0]]l]); 

System. out .println (" scalar  = " + 1); 
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string  topconf ig  = " " ; 
String  baseconfig  = " " ; 


for(int  i=0;  i<6;  i++) 

{ 

topconf ig+=  Long . toString ( { long) Math. ceil ( (double) (p[i] [0]/l)*10000.0))+"x" 
+Long . toString ( (long) Math. ceil ( (double) (p[i] [l]/l)*10000.0))+"x”; 
baseconf ig+=Long . toString ( ( long) Math .ceil ( (double) (p[i+6] [0] /I) *10000.0) )+"x" 
+Long . toString ( ( long) Math . ceil ( ( double) (p[i+6] [l]/l)*10000.0))+"x"; 


) 


//  server  URL  and  the  ASP  page  location 

String  qiurl  = "http: //localhost/QIDB/QIDB.ASP?top="  + topconfig 
+ "&base="  + baseconfig; 


//  connect  to  the  server 
try  { 

URL  maxdet  = new  URL (qiurl ); 

URLConnection  uc  = maxdet . openConnection () ; 

Buf feredReader  in  = new  Buf f eredReader ( 

new  InputStreamReader ( 

uc.getlnputstream( ) ) ) ; 

//  return  value  from  the  server 
result  = in . readLine ( ) ; 
if  (result .equals ( "FOUND" ) ) 

{ 

pdata. setMaxdet (Float . valueOf ( in . readLine ( ) ) . f loatValue ( ) *1*1*1 ) ; 
retval  = in . readLine () ; 

maxpos[0]  = Float .valueOf (retval ). f loatValue () *1 ; 
retval  = in .readLine 0 ; 

maxposll]  = Float .valueOf (retval ). f loatValue () *1 ; 
retval  = in . readLine () ; 

maxpos[2)  = Float .valueOf ( retval ). f loatValue () *1 ; 
retval  = in . readLine () ; 

maxrottO]  = Float. valueOf (retval) . floatValue () ; 
retval  = in. readLine {) ; 

maxrot[l]  = Float .valueOf (retval ). floatValue () ; 
retval  = in. readLine () ; 

maxrot[2]  = Float .valueOf (retval ). floatValue (); 


pdata . setMaxpos (maxpos ) ; 
pdata . setMaxrot (maxrot ) ; 
pdata. setMaxdetFound( true) ; 

messagetext="The  DetJm  of  the  platform  found. \n" 

+"DetJm  = " +Float . toString (pdata.getMaxdet ())+" \n” 

+"Pxyz  = " +Float . toString (maxpos [0] ) +"  " 

+Float . toString (maxpos [11 ) +"  " 

+Float . toString (maxpos [2] ) +" \n" 

+"Rxyz  = "+Float . toString (maxrot [0] ) +"  " 

+Float . toString (maxrot [1 ]) +"  " 

+Float . toString (maxrot (21); 

//  found  dialog 

message  = new  MessageDialog (new  Frame  (), "Message  Dialog",  true,  messagetext) ; 
message . show ( ) ; 


if  (result.equals( "PROCESSING") ) 

{ 

//  processing  dialog 

pdata . setMaxdetFound ( false) ; 

messagetext= "The  DetJm  of  the  platform  is  not  on  the  database. \n" 

+"The  search  program  has  started  on  the  server. \n" 

+" Please  try  later  to  get  the  result."; 
message  = new  MessageDialog (new  Frame (), "Message  Dialog",  true,  messagetext); 
message . show ( ) ; 
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if  (result .equals ( "WAIT" ) ) 

{ 

//  wait  dialog 

pdata . setMaxdetFound( false) ; 

messagetext=”The  DetJm  of  the  platform  is  not  on  the  database. \n" 

+ "Another  search  program  is  already  running  on  the  server. \n" 
+"Only  one  process  of  the  search  program  is  allowed. \n" 

+"Please  try  again  later  to  start  the  search  program."; 
message  = new  MessageDialog (new  Frame (), "Message  Dialog",  true,  messagetext) 
message . show ( ) ; 

} 

in. close ( ) ; 

) 

catch  (Half ormedURLException  ne)  { 

System. out .println (" Error  : " + ne) ; 

) 

catch  (lOException  ne)  { 

System. out .println ( "Error  : " + ne) ; 

} 


) 


//  get  Jacobian  matrix 
float!] []  get_jacobian ( ) 

{ 

float [][]  jmat  = new  f loat [6] [6] ; 
float!] []  p ;//=  new  f loat !12] !3] ; 
float  1; 


get_j  oint_coords ( ) 


for 

{ 


(int  i=0;  i<6;  i++) 


1 = ( float )Math. sqrt ( (p !i ]! 0] -p !i+6] !0] )* (p ! i ] !0] -p !i+6] !0] ) 

+ (p!i] !l]-p!i  + 6] !l])*(p!i]  !l]-p!i  + 6] !l])  + (p!i] !2]-p!i+6] !2] 
*(p!i]  !2]-p!i  + 6] !2])); 
jmat!0]!i]  = (p!i]  !0] -p!i+6]  !0]  ) /I; 
jmat!l]!i]  = (p ! i ] !1 ] -p !i+6]  !1] ) /I ; 
jmat!2]!i]  = (p  !i ] !2 ] -p  !i  + 6] !2 ] ) /I ; 
jmat!3]!i]  = (p !i ] !1 ] *p !i+6] !2 ] -p ! i ] 
jmat!4] !i]  = (p]i]  !2] 
jmat ! 5] !i]  = (p!i] !0] 


!2]*p!i+6] !1])/1; 
*p!i+6]  !0]-p!i]  !0]*p!i+6]  !2]  )/l,- 
l*p!i+6]  !l]-p!i]  !l]*p!i+6]  !0]  )/l; 


return  jmat; 


//  get  determinant  of  J 
float  get_determinant ( float !]! ] J) 
{ 

float  ans=0; 

float!]  s = new  float!6]; 
float!]!]  D = new  float!5]!6]; 
int  i,j,)c,l,m,n; 

s!0]=0; 

for ( i=0 ; i<6 ; i++) 

{ 

s!l]=0; 

D!0] !i]=0; 
f or ( j=0 ; j<6 ; j++ ) 

{ 

if(j==i)  continue; 
s!2]=0; 

D!l] !j]=0; 

for  {k-0;W<6;'k++) 

{ 


if  (lt==i  I I )t== j ) continue; 
s!3]=0; 
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D[2] [k]=0; 

for ( 1=0 ; 1<6 ; 1++) 

{ 

if (l  = = i I I l==j I I l==k)  continue; 
s(4]=0; 

D[3] [1]=0; 
for  (m=0  ;iri<6  ;m++ ) 

{ 

if (m==i I |m== j I |m==k | |m==l ) continue; 
s[5]=0; 

D[4] [m]=0; 
for (n=0 ;n<6 ; n++ ) 

{ 

if (n==i I I n=  = j I | n==k | | n==l | | n==m)  continue; 

D [4 ] [m] =( float ) Math .pow( -1 ,s[5] )*J[5) [n] ; 
s[5)++; 

) 

D [ 3 ] [!]+=( f 1 oat ) Math. pow (-l,s[4] )*J[4] [m]*D(4] [m] ; 
s [4 1 ++ ; 

} 

D(2] [k]+=(float)Math.pow(-l, s[3J ) *J [ 3 ] [1 ] *D [3 1 [ 1 ] ; 
s[3]++; 

) 

D[l] [ j ]+=( float) Math. pow (-1, s[2] ) * J [2 ] [k] *D [2 ] [k] ; 
s[2]++; 

) 

D[0] li]+= (float )Math.pow(-l,s[l 1 ) *J[1] [ j ] *D[1) [ j ] ; 
s[l]  ++; 

} 

ans+= (float)Math.pow(-l, s[0] ) *J[0] [i] *D[0] [i) ; 
s[0]++; 

) 

return  Math. abs (ans) ; 

) 


//  get  joint  coordinates 
float [ ) [ ] get_joint_coords ( ) 

{ 

float [][]  p = new  float [12] [3] ; 
float]]  tval=  new  float]!]; 
float]]]]  mat  = new  float]4]]4]; 
double]]  m_axis=  new  double]4]; 
double  angle; 

float]]  ppp  = new  float]!]; 

EventOutSFVec! f gnd  = null; 

Float  j Float; 

Doubl e j Doubl e ; 

jDouble=Double.valueOf (rxx.getText ( ) ) ; 
m_axis ] 0] = j Double .doubleValue ( ) ; 
jDouble=Double.valueOf (rxy.getText ( ) ) ; 
m_axis ] 1 ] =j Doubl e . doubleValue ( ) ; 
jDouble=Double.valueOf (rxz .getText ( ) ) ; 
m_axis [2] =j Double .doubleValue ( ) ; 
jDouble=Double.valueOf (rxa. getText ( ) ) ; 
angle= jDouble .doubleValue ( ) *0 . 017453 ; 

jFloat=Float . valueOf ( tx . getText ( ) ) ; 
tval ] 0] =j Float . f loatValue ( ) ; 
jFloat=Float . valueOf ( ty. getText ( ) ) ; 
tval ] 1 ] =j Float . f loatValue ( ) ; 
j Float =Float .valueOf ( tz . getText ( ) ) ; 
tval ]2] =jFloat . f loatValue ( ) ; 

//  generating  current  position  and  orientation  of  the  platform  in  matrix  form 
mat]0]]0]  = (float) (m_axis ] 0 ] *m_axis ] 0] * ( 1 . 0-Math . cos (angle) ) +Math. cos (angle) ) 
mat]l]]0]  = ( float ) (m_axis ] 0 ] *m_axis ] 1 ]♦( 1 . 0-Math. cos (angle) ) 

+m_axis ]2 ] ‘Math. sin (angle) ) ; 

= (float ) (m_axis ]0] *m_axis ]2 ] * (1 . 0 -Math. cos (angle) ) 

-m_axis ] 1 ] ‘Math. sin (angle) ) ; 


mat  ]2]  ]0] 
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mat [ 3 1 

[0) 

= 

O.Of  ; 

mat [ 0 ] 

[11 

( float) (m_axis [ 1 ] *m_axis [0] * ( 1 . 0-Math . cos (angle) ) 
-m_axis [2 ] *Math . sin (angle) ) ; 

mat ( 1 ] 

[1] 

(float) (m_axis [1] *m_axis [1 ] * (1 . 0-Math.cos (angle) ) 
+Math.cos (angle) ) ; 

mat ( 2 ] 

[1] 

- 

( float) (m_axis [1 1 *m_axis [ 2 ] * ( 1 . 0-Math.cos (angle) ) 
+m_axis [0] *Math. sin (angle) ) ; 

mat [ 3 ] 

[11 

- 

O.Of; 

mat [ 0 ] 

[2] 

(float) (m_axis [2 1 *m_axis [0 ] * ( 1 . 0-Math . cos (angle) ) 
+m_axis [1 ] *Math. sin (angle) ) ; 

mat ( 1 ) 

[21 

- 

(float) (m_axis [2] *m_axis [ 1 ] * (1 . 0-Math.cos (angle) ) 
-m_axis [0] *Math. sin (angle) ) ; 

mat [ 2 ] 

[21 

( float) (m_axis [2] *m_axis [2 ] * (1 . 0-Math.cos (angle) ) 
+Math. cos (angle) ) ; 

mat ( 3 ] 

[2] 

O.Of  ; 

mat [ 0 1 

[31 

= 

tval [01 ; 

mat [ 1 ] 

[3] 

tval [11; 

mat [ 2 ] 

[31 

tval [21 ; 

mat [ 3 ] 

[31 

= 

l.Of ; 

//  getting  the  coordinates  of  the  joints  of  the  platform  (initial  position) 
for  (int  i=0;  i<12;  i++) 

{ 

gnd  = (Event0utSFVec3 f ) legnodes [ i ] . getEventOut ( " translation_changed” ) ; 
p[i]  = gnd. getValue ( ) ; 

} 

//  multiply  current  transformation  matrix  to  the  initial  joint  coordinates 
for  (int  i=0;  i<6;  i++)  p [i ] =matrix_multiply (mat , p [i ] ) ; 

return  p; 

} 

//  matrix-vector  multiplication  (4x4,  4x1) 
float []  matrix_multiply ( float [][ ] mat,  float  p[]) 

{ 

float []  pp  = new  float[4]; 
floatn  ans  = new  float[4]; 
float []  ret  = new  float[3]; 

for  (int  i=0;  i<3;  i++)  pp[i]=p[i]; 
pp[3]=1.0f; 

fordnt  i=0;  i<4;  i++) 

{ 

ans[i]  = O.Of; 
for(int  j=0;  j<4;  j++) 

ans [ i ] +=mat [ i ] [ j ] *pp [ j ] ; 

} 

for  (int  i=0;  i<3;  i++) 
ret [ i 1 =ans [i ] ; 

return  ret; 

} 

//  event  handler  for  the  "enable  leg  length  change"  chec)cbox 
void  chec)<boxl_itemStateChanged(ItemEvent  e) 

{ 

eclc  . setValue  (checlcboxl  .getState  ( ) ) ; 

} 


) 
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5.  MessageDialog.java 


/ /Title : 

/ /Copyright : 
/ /Author ; 


VRML  Platform 
Copyright  (c)  2000 
Jaehoon  Lee 


package  Platform; 

import  j ava . awt . * ; 

import  j ava . awt . event . * ; 

import  com.borland. jbcl . layout . * ; 

/**************************************************** ^ 

/*  Message  display  dialog  class  */ 

/it***************************************************  ^ 

public  class  MessageDialog  extends  Dialog 
{ 

Panel  panell  = new  Panel ( ) ; 

XYLayout  xYLayoutl  = new  XYLayout ( ) ; 

Button  OK  = new  Button (); 

TextArea  textAreal  = new  TextArea { "Message  from  Server ",  4 , 1 , TextArea. SCROLLBARS_NONE) 
//  constructor 

public  MessageDialog (Frame  frame.  String  title,  boolean  modal.  String  text) 

{ 

super(frame,  title,  modal); 
enableEvents (AWTEvent .WINDOW_EVENT_MASK) ; 
try 
I 

jblnit ( ) ; 
add (panell ) ; 
pack( ) ; 

) 

catch(Exception  ex) 

{ 

ex.printStackTrace { ) ; 

} 

textAreal . setText ( text ) ; 


public  MessageDialog (Frame  frame) 

{ 

this (frame,  ” ” , false,  ""); 

} 

public  MessageDialog (Frame  frame,  boolean  modal) 

{ 

thi s ( frame , ” " , modal , " " ) ; 

} 

public  MessageDialog (Frame  frame.  String  title) 

{ 

this (frame,  title,  false,  ""); 

} 

void  jblnit ()  throws  Exception 
{ 

panell . setLayout (xYLayoutl ) ; 

OK.  setName  ( "OK" ) ,- 
OK.setLabelC'OK")  ; 

OK. addActionListener (new  java . awt . event . ActionListener ( ) 
{ 

public  void  actionPerformed ( ActionEvent  e) 

{ 

OK_actionPerformed(e) ; 

) 

))  ; 


} 
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xYLayoutl . setHeight ( 156 ) ; 
xYLayoutl . setWidth ( 374 ) ; 
textAreal . setEditable ( false) ; 

panell .add ( text Areal,  new  XYConstraints ( 11 , 12,  351,  90)) 
panel 1. add (OK,  new  XYConstraints ( 125 , 115,  125,  26)); 


protected  void  processWindowEvent (WindowEvent  e) 

{ 

if{e.getID()  ==  WindowEvent .WINDOW_CLOSING) 

{ 

cancel { ) ; 

} 

super .processWindowEvent (e) ; 

) 

void  cancel ( ) 

{ 

dispose ( ) ; 

) 

void  OK_actionPerformed(ActionEvent  e) 

{ 

dispose ( ) ; 

} 


6.  PLATFORM.WRL 

#VRML  V2.0  utf8 

#Title:  VRML  Platform 

#Copyright:  Copyright  (c)  2000 

#Author:  Jaehoon  Lee 

Navigationinfo  {type  ( "EXAMINE"  ]} 

Bac)tground  { s)tyColor  0 0 1} 

DEE  VIEWl  Viewpoint  { 
orientation  1001 
position  0 -50  35 
description  "Home" 

) 

DEE  VIEW2  Viewpoint  { 

orientation  100  1.5708 
position  0 -50  9 
description  "Side" 

} 

DEE  VIEW3  Viewpoint  { 
orientation  0010 
position  0 0 50 
description  "Top" 

> 

DEE  BASE_PLATEORM  Transform  { 
children  [ 

Transform  { 
children  [ 

Shape  { 

appearance  Appearance  { 

material  DEE  BASE_PLATE_COLOR  Material  { 
diffuseColor  0 0.5  0.5 
transparency  0.3 

) 

} 


101 


geometry  IndexedFaceSet ( 

coord  DBF  BASE_PLATE  Coordinate  { 
point  [ 17.3205  -10  -.3, 

0 20  -.3, 

0 20  -.3, 

-17.3205  -10  -.3, 
-17.3205  -10  -.3, 

17.3205  -10  -.3 

17.3205  -10  .3, 

0 20  .3, 

0 20  .3, 

-17.3205  -10  .3, 
-17.3205  -10  .3, 

17.3205  -10  .3, 

0 0 0 


1 

) 

coordindex 


[0,12,1,-!, 
1,12, 2,-1, 

2. 12. 3, -1, 

3. 12. 4, -1, 

4. 12. 5, -1, 

5.12. 0,  -1, 

11,12,10,-1, 

10.12.9, -1, 

9, 12, 8,-1, 

8. 12. 7, -1, 

7. 12. 6, -1, 
6,12,11,-1, 
0,1, 7, 6,-1, 

1.2. 8. 7,  -1, 

2. 3. 9. 8, -1, 

3.4.10.9, -!, 

4.5.11.10, -1, 

5.0. 6.11,-! 


) 

) 

1 

} 

DEF  B_LEG1  Transform  { 

translation  17.3205  -10  0 
rotation  0010 
children  ( 

Transform  { 
children  [ 

Shape  { 

appearance  Appearance  { 
material  Material  { 

diffuseColor  1.0  0.0  0.0 

) 

} 

geometry  Sphere  { 
radius  1 

} 

) 

DEF  TS_B1  PlaneSensor  { 
offset  17.3205  -10  0 
enabled  FALSE 

} 


) 

DEF  B_LEG1A  Transform  { 
rotation  001  2.0944 
children  [ 

DEF  B_LEG1B  Transform  { 
rotation  0-10  0.7854 
children  [ 

DEF  BASE_LEG  Transform  { 

translation  7.500#  half  of  the  height 
rotation  001  -1.5708 
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scale  0.5  15  0.5  # y is  the  height,  x=z  is  radius 
children  [ 

Shape  { 

appearance  Appearance  { 
material  Material  { 

diffuseColor  0.6  0.7  0.6 
transparency  0.2 

) 

) 

geometry  Cylinder  { 
height  1 
radius  1 

) 

) 

DEF  BLEG_SENSOR  PlaneSensor  { 
offset  15  0.5  0 

} 

] 

) 

DEF  T_LEG1A  Transform  { 

translation  14.4949  00#  leglength-height/2 
rotation  001  -1.5708 

scale  0.25  20  0.25  # y is  the  height,  x=z  is  radius 
children  [ 

DEF  TOP_LEG_BAR  Shape  { 
appearance  Appearance  { 
material  Material  ( 

diffuseColor  0.7  0.7  0.7 

} 

) 

geometry  Cylinder  { 
height  1 
radius  1 

} 

} 

DEF  TLEG_SENSOR  PlaneSensor  { 
offset  20  0.25  0 


) 


} 


) 

1 

) 

DEF  B_LEG2  Transform  { 
translation  0 20  0 
rotation  0010 
children  [ 

Transform  { 
children  ( 

DEF  BASE_LEG_BALL  Shape  { 
appearance  Appearance  { 

material  DEF  BASE_BALL_COLOR  Material  { 
diffuseColor  0.5  0.7  0.5 

) 

} 

geometry  Sphere  { 
radius  1 

} 

) 

DEF  TS_B2  PlaneSensor  { 
offset  0 20  0 
enabled  FALSE 

) 

] 

) 

DEF  B_LEG2A  Transform  { 
rotation  001  -1.0472 
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children  [ 

DEF  B_LEG2B  Trains  form  { 
rotation  0-10  0.7854 
children  [ 

USE  BASE_LEG 
DEF  T_LEG2A  Transform  { 
translation  14.4949  0 0 
rotation  001  -1.5708 
scale  0.25  20  0.25 
children  [ 

USE  TOP_LEG_BAR 
USE  TLEG_SENSOR 

] 

} 

1 

) 


} 

] 

} 

DEF  B_LEG3  Transform  { 
translation  0 20  0 
rotation  0010 
children  [ 

Transform  { 
children  [ 

USE  BASE_LEG_BALL 
DEF  TS_B3  PlaneSensor  { 
offset  0 20  0 
enabled  FALSE 

} 

] 

) 

DEF  B_LEG3A  Transform  { 
rotation  001  -2.0944 
children  [ 

DEF  B_LEG3B  Transform  { 
rotation  0-10  0.7854 
children  [ 

USE  BASE_LEG 
DEF  T_LEG3A  Transform  { 
translation  14.4949  0 0 
rotation  001  -1.5708 
scale  0.25  20  0.25 
children  [ 

USE  TOP_LEG_BAR 
USE  TLEG_SENSOR 

1 

} 

1 


DEF  B_LEG4  Transform  { 

translation  -17.3205  -10  0 
rotation  0010 
children  [ 

Transform  { 
children  [ 

USE  BASE_LEG_BALL 
DEF  TS_B4  PlaneSensor  { 
offset  -17.3205  -10  0 
enabled  FALSE 

) 


} 

DEF  B_LEG4A  Transform  { 
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rotation  001  1.0472 
children  [ 

DEF  B_LEG4B  Transform  { 
rotation  0-10  0.7854 
children  [ 

USE  BASE_LEG 
DEF  T_LEG4A  Transform  { 
translation  14.4949  0 0 
rotation  001  -1.5708 
scale  0.25  20  0.25 
children  [ 

USE  TOP_LEG_BAR 
USE  TLEG_SENSOR 

1 

) 

] 

} 


} 

] 

} 

DEF  B_LEG5  Transform  { 

translation  -17.3205  -10  0 
rotation  0010 
children  [ 

Transform  { 
children  [ 

USE  BASE_LEG_BALL 
DEF  TS_B5  PlaneSensor  { 
offset  -17.3205  -10  0 
enabled  FALSE 

) 

) 

} 

DEF  B_LEG5A  Transform  { 
rotation  0010 
children  [ 

DEF  B_LEG5B  Transform  { 
rotation  0-10  0.7854 
children  [ 

USE  BASE_LEG 
DEF  T_LEG5A  Transform  { 
translation  14.4949  0 0 
rotation  001  -1.5708 
scale  0.25  20  0.25 
children  [ 

USE  TOP_LEG_BAR 
USE  TLEG_SENSOR 

1 

} 


} 


} 

] 

) 

DEF  B_LEG6  Transform  { 

translation  17.3205  -10  0 
rotation  0010 
children  [ 

Transform  { 
children  [ 

USE  BASE_LEG_BALL 
DEF  TS_B6  PlaneSensor  { 
offset  17.3205  -10  0 
enabled  FALSE 

) 

] 

} 
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DEF  B_LEG6A  Transform  { 
rotation  001  3.1416 
children  [ 

DEF  B_LEG6B  Transform  { 
rotation  0 -1  0 0.7854 
children  [ 

USE  BASE_LEG 
DEF  T_LEG6A  Transform  { 
translation  14.4949  0 0 
rotation  001  -1.5708 
scale  0.25  20  0.25 
children  [ 

USE  TOP_LEG_BAR 
USE  TLEG_SENSOR 


} 


} 


) 


] 


) 


} 


DEF  TOP_PLATFORM  Transform  { 
translation  0 0 17.3205 
rotation  0010 
children  [ 

Transform  { 
children  [ 

Shape  { 

appearance  Appearance  { 
material  Material  { 

diffuseColor  0.5  0.5  0.5 
transparency  0 . 3 

} 

} 


geometry  IndexedFaceSet{ 

coord  DEF  TOP_PLATE  Coordinate 
point  [ 8.6603  5 -.3, 
8.6603  5 -.3, 
-8.6603  5 -.3, 
-8.6603  5 -.3, 

0 -10  -.3, 

0 -10  -.3 
8.6603  5 .3, 

8.6603  5 .3, 
-8.6603  5 .3, 
-8.6603  5 .3, 

0 -10  .3, 

0 -10  .3, 

0 0 0 


coordindex  [0,12,1,-!, 

1,12, 2,-1, 

2. 12. 3, -1, 

3. 12. 4, -1, 

4. 12. 5, -1, 
5,12,0, -1, 
11,12,10,-1, 
10,12,9,-1, 
9, 12, 8, -1, 

8. 12. 7,  -1, 

7. 12. 6, -1, 
6,12,11,-1, 
0,1, 7, 6,-1, 

1.2. 8. 7, -1, 

2. 3. 9. 8, -1, 


{ 
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3.4.10.9,  -1, 

4.5.11.10, -1, 
5,0,6,11,-! 


} 

) 

1 

) 

DEF  T_LEG1  Transform  { 
translation  8.6603  5 0 
rotation  0010 
children  [ 

DEF  T_LEG1B  Transform  { 
children  [ 

Shape  { 

appearance  Appearance  { 
material  Material  { 

diffuseColor  1.0  0.0  0.0 

} 

} 

geometry  Sphere  { 
radius  0 . 5 

) 

} 

DEF  TS_T1  PlaneSensor  { 
offset  8.6603  5 0 
enabled  FALSE 

} 


) 

1 

} 

DEF  T_LEG2  Trcinsform  { 
translation  8.6603  5 0 
rotation  0010 
children  [ 

DEF  T_LEG2B  Transform  { 
children  [ 

DEF  TOP_LEG_BALL  Shape  { 
appearance  Appearance  { 

material  DEF  TOP_BALL_COLOR  Material  ( 
diffuseColor  0.7  0.7  0.7 

) 

} 

geometry  Sphere  { 
radius  0.5 

) 

} 

DEF  TS_T2  PlaneSensor  { 
offset  8.6603  5 0 
enabled  FALSE 

} 

] 

} 


) 

DEF  T_LEG3  Transform  { 

translation  -8.6603  5 0 
rotation  0010 
children  [ 

DEF  T_LEG3B  Transform  { 
children  [ 

USE  TOP_LEG_BALL 
DEF  TS_T3  PlaneSensor  { 
offset  -8.6603  5 0 
enabled  FALSE 
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DEF  T_LEG4  Transform  { 

translation  -8.6603  5 0 
rotation  0010 
children  [ 

DEF  T_LEG4B  Transform  { 
children  ( 

USE  TOP_LEG_BALL 
DEF  TS_T4  PlaneSensor  { 
offset  -8.6603  5 0 
enabled  FALSE 

) 


} 

1 

} 

DEF  T_LEG5  Transform  { 
translation  0 -10  0 
rotation  0010 
children  [ 

DEF  T_LEG5B  Transform  { 
children  [ 

USE  TOP_LEG_BALL 
DEF  TS_T5  PlaneSensor  { 
offset  0 -10  0 
enabled  FALSE 

) 


) 


DEF  T_LEG6  Transform  { 
translation  0 -10  0 
rotation  0010 
children  [ 

DEF  T_LEG6B  Transform  { 
children  [ 

USE  TOP_LEG_BALL 
DEF  TS_T6  PlaneSensor  { 
offset  0 -10  0 
enabled  FALSE 


) 


) 


) 


# script  node  for  leg  position  and  orientation 
DEF  LEGS  Script { 

directOutput  TRUE 
event In  SFVec3f  xyz 
eventin  SFRotation  rxyz 
eventin  SFVec3f  txyz 
eventin  SFVec3f  bxyz 

field  SFNode  top_platform  USE  TOP_PLATFORM 

field  SFNode  top_plate  USE  TOP_PLATE 

field  SFNode  baseplate  USE  BASE_PLATE 

field  SFNode  bll  USE  B_LEG1 

field  SFNode  blla  USE  B_LEG1A 

field  SFNode  bllb  USE  B_LEG1B 

field  SFNode  bl2  USE  B_LEG2 

field  SFNode  bl2a  USE  B_LEG2A 

field  SFNode  bl2b  USE  B_LEG2B 

field  SFNode  bl3  USE  B_LEG3 

field  SFNode  bl3a  USE  B_LEG3A 

field  SFNode  bl3b  USE  B_LEG3B 

field  SFNode  bl4  USE  B LEG4 


changes 
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field  SFNode  bl4a  USE  B_LEG4A 
field  SFNode  bl4b  USE  B_LEG4B 
field  SFNode  bl5  USE  B_LEG5 
field  SFNode  bl5a  USE  B_LEG5A 
field  SFNode  bl5b  USE  B_LEG5B 
field  SFNode  bl6  USE  B_LEG6 
field  SFNode  bl6a  USE  B_LEG6A 
field  SFNode  bl6b  USE  B_LEG6B 
field  SFNode  til  USE  T_LEG1 
field  SFNode  tlla  USE  T_LEG1A 
field  SFNode  tl2  USE  T_LEG2 
field  SFNode  tl2a  USE  T_LEG2A 
field  SFNode  tl3  USE  T_LEG3 
field  SFNode  tl3a  USE  T_LEG3A 
field  SFNode  tl4  USE  T_LEG4 
field  SFNode  tl4a  USE  T_LEG4A 
field  SFNode  tl5  USE  T_LEG5 
field  SFNode  tl5a  USE  T_LEG5A 
field  SFNode  tl6  USE  T_LEG6 
field  SFNode  tl6a  USE  T_LEG6A 
url  "javascript: 

function  resize_top_plate ( ) 

{ 

top_plate .point (0 ] =top_plate .point [6] =tll . translation; 
top_plate .point [0] (2]=-0.3; 
top_plate.point [6]  [2]=0.3; 

top_plate .point [1 ] =top_plate .point [7 ] =tl2 . translation; 
top_plate .point [1 1 [2]=-0.3; 
top_plate.point [7] [2]=0.3; 

top_plate .point [2 ] =top_plate .point [8] =tl3 . translation; 
top_plate.point [2] [2]=-0.3; 
top_plate.point [8] [2]=0.3; 

top_plate .point [3 ] =top_plate .point [9] =tl4 . translation; 
top_plate .point [3 1 [2]=-0.3; 
top_plate.point [9] [2]=0.3; 

top_plate .point [4] =top_plate .point [10] =tl5 . translation; 
top_plate .point [4 ] (2]=-0.3; 
top_plate. point [10]  [2]=0.3; 

top_plate .point [5] =top_plate .point [11] =tl6 . translation; 
top_plate.point [5] [2]=-0.3; 
top_plate. point [11] [2]=0.3; 

top_plate. point [12] [ 0] =top_plate .point [12 ] [1 ] =top_plate .point [12] [2]=0.0; 

} 

function  resize_base_plate ( ) 

{ 

base_plate .point [ 0 ] =base_plate .point [6] =bll . translation; 
base_plate .point [ 0 ] [2]=~0.3; 
base_plate .point [ 6 ] [2]=0.3; 

base_pl ate .point [ 1 ] =base_pl ate .point [7 ] =bl2 . translation; 
base_plate .point [ 1 ] [2]=-0.3; 
base_plate .point [7 ] [2]=0.3; 

base_plate .point [2 ] =base_plate .point [8] =bl3 . translation; 
base_plate .point [2 ] [2]=-0.3; 
base_plate.point [8] [2]=0.3; 

base_pl ate .point [3 ] =base_plate .point [9] =bl4 . translation; 
base_plate.point [3 ] [2]=-0.3; 
base_plate .point [9 ] [2]=0.3; 

base_plate .point [4 ] =base_plate .point [10] =bl5 . translation; 
base_plate .point [4 ] [2]=-0.3; 
base_plate. point [10] [2]=0.3; 

base_pl ate .point [ 5 ] =base_plate .point [11 ] =bl6 . translation; 
base_plate .point [ 5 ] [2]=-0.3; 
base_plate .point ( 11 ] [2]=0.3; 

base_plate. point [ 12 ] [0 ] =base_plate .point [ 12 ] [1] =base_plate. point [12] [2]=0.0; 

) 

function  adjusting]) 

{ 


vecf =top_plat form. rotation .multVec { til . translation) ; 
dx=vecf [0] +top_platform. translation [0 ] -bll . translation [0] 
dy=vecf [1 ] +top_platform. translation [ 1 ] -bll . translation [ 1 ] 
dz=vecf [ 2 ] +top_platform. translation [2 ] -bll . translation [2 ] 
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blla .  rotation [3 1 =Math .atan2 (dy, dx) ; 

bl lb.  rotation [ 3 ] =Math. atan2 (dz , Math. sqrt (dx*dx+dy*dy) ) ; 
llen=Math . sqrt (dx*dx+dy*dy+dz*dz ) ; 

tlla . translation [0] =llen- tlla .scale[l]/2; 

vecf  = top_platf orm. rotation.mul tVec ( tl2 . translation)  ; 
dx=vecf [ 0 ] +top_platf orm. translation [ 0] -bl2 . translation [ 0] ; 
dy=vecf [1] +top_platf orm. translation [1] -bl2 . translation [ 1 ] ; 
dz=vecf [2 ] +top_platform. translation [2] -bl2 . translation (2 ) ; 
bl2a . rotation [3 ] =Math. atan2 (dy, dx) ; 

bl 2b. rotation [ 3 ] =Math. atan2 (dz , Math. sqrt (dx*dx+dy*dy) ) ; 

llen=Math . sqrt (dx*dx+dy*dy+dz*dz ) ; 

tl2a . translation [0]=llen-tl2a. scale [l]/2; 

vecf =top_plat form. rotation. multVec ( tl3 . translation) ; 
dx=vecf [0] +top_platf orm. translation [0] -bl3 . translation [0] ; 
dy=vecf [ 1 ] +top_platform. translation [1] -bl3 . translation [ 1 ] ; 
dz=vecf [ 2 ] +top_platform. translation [2] -bl3 . translation [2 ] ; 
bl3a . rotation [3 ) =Math. atan2 (dy, dx) ; 

bl 3b. rotation [3 ] =Math. atan2 (dz ,Math . sqrt (dx*dx+dy*dy) ) ; 

llen=Math. sqrt (dx*dx+dy*dy+dz*dz ) ; 

tl3a . translation [0]=llen-tl3a.scale[l)/2; 

vecf =top_pl at form. rot at ion. multVec ( tl4 . translation) ; 
dx=vecf [0] +top_platf orm. translation [0] -bl4 . translation [0 ) ; 
dy=vecf [ 1 ] +top_platf orm. translation [ 1 ] -bl4 . translation [1] ; 
dz=vecf [2] +top_platform. translation [2 ] -bl4 . translation [2 ] ; 
bl 4a . rotation [3 ] =Math. atan2 (dy, dx) ; 

bl 4b. rotation [3 1 =Math. atan2 (dz , Math. sqrt (dx*dx+dy*dy ) ) ; 

llen=Math.sqrt (dx*dx+dy*dy+dz*dz ) ; 

tl4a . translation [ 0 1 =llen-tl4a . scale [1 ) /2; 

vecf =top_platf orm. rotation .multVec ( tl5 . translation) ; 
dx=vecf [0 1 +top_platform. translation [0] -bl5 . translation [0] ; 
dy=vecf [1 ] +top_platf orm. translation [1 ] -bl5 . translation [1 ] ; 
dz=vecf [2 ] +top_platf orm. translation [2] -bl5 . translation [2] ; 
bl5a . rotation [3 ] =Math. atan2 (dy , dx) ; 

bl 5b. rotation [3 ] =Math.atan2 (dz , Math. sqrt {dx*dx+dy*dy) ) ; 

llen=Math. sqrt (dx*dx+dy*dy+dz*dz ) ; 

tl5a. translation [0] =llen-tl5a . scale [l]/2; 

vecf =top_platf orm. rotation .multVec ( tl6 . translation) ; 
dx=vecf [0] +top_platf orm. translation [0 ] -bl6 . translation [0] ; 
dy=vecf [1 ] +top_platform. translation [ 1 ] -bl6 . translation [1 ] ; 
dz=vecf [2 ] +top_platform. translation [2 ] -bl6 . translation [2 ] ; 
bl6a . rotation [3 1 =Math. atan2 (dy, dx) ; 

bl 6b. rotation [3 ] =Math. atan2 (dz , Math. sqrt (dx*dx+dy*dy) ) ; 

llen=Math. sqrt {dx*dx+dy*dy+dz*dz ) ; 

tl6a . translation [ 0 ] =llen-tl6a . scale [ 1 ] /2 ; 

) 

function  xyz (value)  { adjusting));  ) 
function  rxyz(value)  { adjusting));  } 
function  txyz (value) 

{ 

adjusting ( ) ; 
resize_top_plate ( ) ; 


function  bxyz (value) 

{ 

adjusting ( ) ; 
resize_base_plate ( ) ; 

)" 

} 

# script  for  base  leg  length  change  (visual) 

DEF  LEG_LEN_CHANGE  Script  { 
directOutput  TRUE 
eventin  SFVec3f  trin 
field  SFNode  blegtr  USE  BASE_LEG 
url  "javascript: 
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function  trin (value) 

{ 

if  (value[0]<2) 

{ 

blegtr . scale [1 ] =2 ; 
blegtr . translation [0] =1  ; 

} 

else 

{ 

blegtr . scale ( 1 ] =value [0 ] ; 
blegtr . translation [0] =value [0 ] /2 ; 

} 

}" 

} 


# script  for  top  leg  length  change  (visual) 

DEF  LEG_LEN_CHANGE2  Script  { 

directOutput  TRUE 
eventin  SFVec3f  trin 
field  SFNode  tlla  USE  T_LEG1A 
field  SFNode  tl2a  USE  T_LEG2A 
field  SFNode  tl3a  USE  T_LEG3A 
field  SFNode  tl4a  USE  T_LEG4A 
field  SFNode  tl5a  USE  T_LEG5A 
field  SFNode  tl6a  USE  T_LEG6A 
url  "javascript: 

function  trin (value) 

{ 

llenl=tlla . translation [0] +tlla. scale [11/2 
1 len2=t 12a. translation [0 ] +tl2a . scale [1 ] /2 
Ilen3=tl3a . translation [0] +tl3a . scale [1 ] /2 
Ilen4=tl4a . translation [0] +t 14a. scale [1 ] /2 
Ilen5=tl5a . translation [0] +tl5a. scale [1 ] /2 
Ilen6=tl6a. translation [0] +tl6a . scale [1 ] 12 

if  (value [0]<D 

{ 

tlla . scale [1 ) =1 ; 

tlla . translation [0] =llenl-0 . 5 ; 

tl2a. scale [1]=1; 

t 12a. translation [0] =llen2-0 . 5 ; 

tl3a . scale [ 1] =1 ; 

tl3a . translation [0] =llen3-0 . 5 ; 

tl4a . scale [ 1 ] =1 ; 

tl4a . translation [0 ] =llen4-0 . 5 ; 

tl5a . scale [1 ] =1 ; 

tl5a. translation [0] =llen5-0 . 5 ; 

tl6a. scale [1 ] =1; 

t 16a. translation [0] =llen6-0 . 5 ; 

} 

else 

{ 

tlla . scale [ 1 ] = value [0] ; 

tlla. translation [0] =llenl -value [0] /2 ; 

tl2a. scale [ 1 1 =value [0 ) ; 

tl2a . translation [0] =llen2 -value [0 ] /2 ; 

tl3a . scale [1 ] = value [0] ; 

tl3a . translation [0] =llen3 -value [0] /2 ; 

tl4a . scale [ 1 ] =value [ 0 ] ; 

tl4a . translation [0] =llen4- value [ 0 ] /2 ; 

tl5a.scale[l]=value[0] ; 

tl5a . translation [0] =llen5 -value [0]/2; 

tl6a. scale [ 1 ) =value [0] ; 

tl6a . translation [0] =llen6 -value [0] /2 ; 

) 

}" 

} 

# main  connection  gate  to  the  Java  Applet 
DEF  EAI_CONTROL  Script  { 

directOutput  TRUE 


Ill 


eventin  SFVec3f  translation 
eventin  SFRotation  rotation 


eventin  SFVec3f  motion_reset 
eventin  SFFloat  triangular_top_set 
eventin  SFVec3f  hexagonal_top_set 
eventin  SFBool  custom_top_set 
eventin  SFFloat  triangular_base_set 
eventin  SFVec3f  hexagonal_base_set 
eventin  SFBool  custom_base_set 


eventin  SFBool  connector_length 

field  SFNode  top_platform  USE  TOP_PLATFORM 

field  SFNode  til  USE  T_LEG1 

field  SFNode  tl2  USE  T_LEG2 

field  SFNode  tl3  USE  T_LEG3 

field  SFNode  tl4  USE  T_LEG4 

field  SFNode  tl5  USE  T_LEG5 

field  SFNode  tl6  USE  T_LEG6 

field  SFNode  bll  USE  B_LEG1 

field  SFNode  bl2  USE  B_LEG2 

field  SFNode  bl3  USE  B_LEG3 

field  SFNode  bl4  USE  B_LEG4 

field  SFNode  bl5  USE  B_LEG5 

field  SFNode  bl6  USE  B_LEG6 

field  SFNode  pstl  USE  TS_T1 

field  SFNode  pst2  USE  TS_T2 

field  SFNode  pst3  USE  TS_T3 

field  SFNode  pst4  USE  TS_T4 

field  SFNode  pst5  USE  TS_T5 

field  SFNode  pst6  USE  TS_T6 

field  SFNode  psbl  USE  TS_B1 

field  SFNode  psb2  USE  TS_B2 

field  SFNode  psb3  USE  TS_B3 

field  SFNode  psb4  USE  TS_B4 

field  SFNode  psb5  USE  TS_B5 

field  SFNode  psb6  USE  TS_B6 

field  SFNode  tlegsr  USE  TLEG_SENSOR 

field  SFNode  blegsr  USE  BLEG_SENSOR 

field  SFNode  tbc  USE  TOP_BALL_COLOR 

field  SFNode  bbc  USE  BASE_BALL_COLOR 


url  "javascript: 

function  translation (value) 

{ 

top_platf orm. translation=value; 

) 

function  rotation (value) 

{ 

top_plat f orm. rotation=top_plat form. rotation .multiply (value) ; 

} 

function  motion_reset (value) 

{ 

top_platf orm. translation [0] =value [ 0 ] ; 
top_platf orm. translation [1 1 =value (1 ] ; 
top_platf orm. translation [2 ] =value [2]; 

/ /top_plat form. rotation [0]=0.0; 

/ /top_plat form. rotation [1]=0.0; 

/ / top_platf orm. rotation [2 ] =1 . 0 ; 

/ / top_platf orm. rotation [ 3 ] =0 . 0 ; 

} 

function  triangular_top_set (value) 

{ 

til . translation [ 0 ] =pstl .offset(0)=0 . 5*value; 
til . translation (1 ] =pstl .offset[l]=0. 2 8 87* value; 
til . translation [ 2 ) =pstl .offset[2]=0.0; 

tl2 . translation [0 ] =pst2 .offset [01=0. 5 * value; 
tl2 . translation [ 1 ] =pst2 .offset [ 1 ) =0 . 2 887 ‘value; 
tl2 . translation [2 ] =pst2 .offset [2] =0 . 0 ; 

tl3 . translation [ 0 ) =pst3 .offset[0]=-0. 5 ‘value; 
tl3 . translation [ 1 ] =pst3 .offset[l]=0 . 2 887 ‘value; 
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tl3 . translation [2 ] =pst3 .offset[2]=0.0; 

tl4 . translation [ 0 ] =pst4 .offset [ 0] =-0 . 5 ‘value; 
tl4 . translation [ 1 ] =pst4 .offset[l]=0. 2 887 ‘value ; 
tl4 . translation ( 2 ] =pst4 .offset[2]=0.0; 

tl5 . translation [0 ) =pst5 .offset[0]=0.0; 

tl5 . translation [ 1 ] =pst5 .offset[l)=-0. 5774 ‘value ; 

tl5 . translation [2 ] =pst5 .offset[2]=0.0; 

tie . translation [0 ] =pst6.offset[0)=0.0; 

tie . translation [1 ] =pste .offset[l]=-0. 57 74 ‘value ; 

tie . translation [2 ] =pste .offset[2]=0.0; 

tbc . di f f useColor (01=0.7; 
tbc . diff useColor [ 1 ] =0 . 7 ; 
tbc  .diff  useColor  [2  ] = 0 . 7 

pstl. enabled  = FALSE; 
pst2. enabled  = FALSE; 
pst3. enabled  = FALSE; 
pst4. enabled  = FALSE; 
pst 5. enabled  = FALSE; 
pste. enabled  = FALSE; 


function  triangular_base_set (value) 

{ 

bll . translation ( 0 ] =psbl .offset[0]=0. 5 ‘value; 
bll . translation [ 1 ] =psbl .offset[l]=-0. 2 8 87 ‘value; 
bll . translation [2 ] =psbl .offset[2]=0.0; 

bl2 . translation [0 ] =psb2 .offset[0J=0.0; 

bl2 . translation [ 1 ] =psb2 . offset [ 1 ] =0 . 57 74 ‘value ; 

bl2 . translation [2 ] =psb2 . offset [21=0.0; 

bl3 . translation [0 1 =psb3 .offset [01=0.0; 

bl3 . translation [1 ] =psb3 .offset[ll=0. 5774 ‘value ; 

bl3 . translation [2 1 =psb3 .offset[21=0.0; 

bl4 . translation [ 0 1 =psb4 .offset [ 0] =-0 . 5‘value; 
bl4 . translation [1 1 =psb4 .of f set [ 1 1 =-0 . 2887‘value; 
bl4 . translation [2 1 =psb4 .offset[21=0.0; 

bl5 . translation [01 =psb5 . of f set [01 =-0 . 5‘value; 
bl5 . translation [1 1 =psb5 .offset[ll=-0. 2887‘value; 
bl5 . translation [2 1 =psb5 .offset[21=0.0; 

bl6 . translation [ 0 1 =psb6 .offset[01=0. 5‘value; 
bl6 . translation [1 1 =psb6 .offset[ll=-0. 2887‘value; 
bl6 . translation [2 ] =psb6 .offset[21=0.0; 

bbc . diff useColor [01=0.6; 
bbc .diff useColor [11=0.7; 
bbc .diff useColor [21=0.6; 

psbl. enabled  = FALSE; 
psb2. enabled  = FALSE; 
psb3. enabled  = FALSE; 
psb4. enabled  = FALSE; 
psb5. enabled  = FALSE; 
psb6. enabled  = FALSE; 


function  hexagonal_top_set (value) 

{ 

a=value [01 ; 
ap=value [11 /lOO ; 
if  (value [2 1 ==0 ) 

{ 


til . translation [01 =pstl .offset[01=0.5‘ (1-ap) ‘a 
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til . translation [ 1 ] =pstl .offset [1]=(0. 2887-0. 8660* ap)*a; 

tl2 . translation [0] =pst2 .offset[0]=(0.5-ap)*a; 
tl2 . translation [ 1 ] =pst2 .offset[l]=0.2887*a; 

tl3 . translation [ 0 ] =pst3 .offset[0]=(-0.5+ap)*a; 
tl3 . translation [1 ] =pst3 .offset[l]=0.2887*a; 

tl4 . translation [0] =pst4 .offset[0]=-0.5*(l-ap)*a; 

tl4 . translation [ 1 1 =pst4 . off set[l]=(0. 2887-0. 8660* ap)*a; 

tl5 . translation [ 0] =pst5 .offset[0]=-0.5*a*ap; 

tl5 . translation [1 ] =pst5. off set[l]=(-0. 5774+0. 8660* ap)*a 

tl6 . translation [0 ] =pst6 .offset[0]=0.5*a*ap; 

tl6 . translation [1 ] =pst6 . off set[ll={-0. 5774+0. 8660* ap)*a 


if  (value [2 ] ==1 ) 

{ 

til . translation [ 0 ] =pstl .offset[0]=0.5*(l-ap)*a; 

til . translation [ 1 ] =pstl . off set[l]=(0. 2887-0. 8660* ap)*a; 

tl2 . translation [0] =pst2 .offset[0)=0.5*a; 
tl2 . translation [1 ] =pst2 .offset[l]=0.2887*a; 

tl3 . translation [0] =pst 3 .offset[0]=(-0.5+ap)*a; 
tl3 . translation [1 ] =pst3 .offset[l]=0.2887*a; 

tl4 . translation [ 0] =pst4 .offset[0]=-0.5*a; 
tl4 . translation [1 ) =pst4 .offset[l]=0.2887*a; 

tl5 . translation [ 0 ] =pst5 .offset[0]=-0.5*a*ap; 

tl5 . translation [ 1 ] =pst5 . off set[l]=(-0. 5774+0. 8660* ap)*a 

tl6 . translation [0] =pst6 .offset[0)=0.0; 

tl6 . translation [1 ] =pst6 .offset[l]=-0.5774*a; 


if  (value [2 1 ==2 ) 

{ 

til . translation [0] =pstl .offset[0]=0.5*a; 
til . translation [ 1 ] =pstl .offset[l]=0.2887*a; 

tl2 . translation [0] =pst2 .offset[0]=0.5*a* (1-ap) ; 
tl2 . translation [1 ] =pst2 .offset [l]=0.2887*a* (1-ap) ; 

tl3 . translation [0] =pst3 .offset[0]=-0.5*a; 
tl3 . translation [ 1] =pst3 .offset[lj=0.2887*a; 

tl4 . translation [0] =pst4 .offset(0J=-0.5*a* (1-ap) ; 
tl4 . translation [1 ] =pst4 .offset[l]=0.2887*a* (1-ap) ; 

tl5 . translation [0] =pst5 .offset [0] =0 . 0; 

tl5 . translation [1 ] =pst5 .offset [l]=-0.5774*a; 

tl6 . translation [0] =pst6 .offset[0]=0.0; 

tl6 . translation [ 1 1 =pst6 .offset[l]=-0.5774*a* (1-ap) ; 


til . translation [2 ] =pstl .offset[2]=0.0; 
tl2 . translation [ 2 ] =pst2 . offset [2 ] =0 . 0 ; 
tl3 . translation [2 ] =pst3 .offset[2]=0.0; 
tl4 . translation [ 2 ] =pst4 .offset[2]=0.0; 
tl5 . translation [ 2 ] =pst5 .offset[2]=0.0; 
tl6 . translation [ 2 ] =pst6 .offset[2]=0.0; 

tbc .dif fuseColor [01=0.7; 
tbc . dif fuseColor [ 1 J = 0 . 7 ; 
tbc . di f fuseColor [21=0.7; 


114 


pstl . enabled 
pst2 . enabled 
pstl .enabled 
pst4 . enabled 
pst5 . enabled 
pst6 . enabled 


FALSE 

FALSE 

FALSE 

FALSE 

FALSE 

FALSE 


function  hexagonal_base_set (value) 

{ 

b=value [0]; 
bp=value [1 ) /lOO ; 
if  (value [2] ==0) 

{ 

bll . translation [0 ] =psbl . of f set [0] =0 . 5* ( 1-bp) *b; 

bll . translation [1] =psbl . off set[l]=(-0. 2887+0. 8660*bp )*b; 

bl2 . translation [0] =psb2 .offset[0]=0. 5*b*bp; 

bl2 . translation [ 1 ) =psb2 .offset(l]=(0. 5774-0. 8660*bp )*b; 

bll . translation [0] =psbl . offset [0 ] =-0 . 5*b*bp; 

bll . translation [ 1 ] =psbl .offset [1]=(0. 5774-0. 8660*bp) *b; 

bl4 . translation [0] =psb4 .offset[0]=-0.5*(l-bp)*b; 

bl4 . translation [1 ] =psb4 .of f set [1 ] = (-0.2887+0 . 8660*bp) *b; 

bl5  . treinslation  [ 0 1 =psb5  .offset[0]  = (-  0. 5+bp)  *b; 
bl5 . translation [1] =psb5 .offset[l]=-0.2887*b; 

bl6 . translation [0] =psb6 .offset [0 ] = ( 0 . 5-bp) *b; 
bl6 . translation [1] =psb6 . off set[l]=-0. 2887 *b; 


if  (value [2 1 ==1 ) 

{ 

bll . translation [0 ) =psbl . of f set [ 0] =0 . 5*b; 
bll . translation [1 ] =psbl .offset[l]=-0.2887*b; 

bl2 . translation [0 ] =psb2 . of f set [0] =0 . 5*b*bp; 

bl2 . translation [1] =psb2 .offset [1]=(0. 5774-0. 8660*bp )*b; 

bll . translation [0) =psbl .offset [0 ] =0 . 0 ; 
bll . translation [ 1 ] =psbl . offset [l]=0.5774*b; 

bl4 . translation [0] =psb4 . offset [0] =-0 . 5* (1-bp) *b; 

bl4 . translation [ 1 ] =psb4 . of f set [1 ] =(-0.2887+0. 8660 *bp) *b; 

bl5 . translation [0] =psb5 .offset[0]=-0.5*b; 
bl5 . translation [1] =psb5 . off set[l]=-0. 2887 *b; 

bl6 . translation [0] =psb6 .offset [0 ] = ( 0 . 5 -bp) *b; 
bl6 . translation ( 1 ] =psb6 . of f set [1 ) =-0.2887*b; 


if  (value [2 ] ==2 ) 

{ 

bll . translation [ 0 ] =psbl .offset [0] =0 . 5*b; 
bll . translation [ 1 ] =psbl . offset [l]=-0.2887*b; 

bl2 . translation [0] =psb2 .offset[0]=0.0; 

bl2 . translation [ 1 ] =psb2 .offset[l]=0.5774*b*(l-bp) ; 

bll . translation [0] =psbl .offset[0J=0.0; 
bll . translation [ 1 ] =psbl .offset[l]=0.5774*b; 

bl4 . translation [0 ) =psb4 . offset (0)=-0.5*b* ( 1-bp) ; 
bl4 . translation [ 1 ] =psb4 .offset [l]=-0.2887*b* (1-bp) ; 

bl5 . translation [0 1 =psb5 .offset[0)=-0.5*b; 
bl5 . translation [ 1 ] =psb5 . offset [l]=-0.2887*b; 
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bl6 . translation [0] =psb6 .offset[0]=0.5*b* (1-bp) ; 
bl6 . translation [ 1 ] =psb6 .offset[l]=-0.2887*b*(l-bp) 

) 

bbc .dif fuseColor [ 0] =0 . 6 ; 
bbc .dif fuseColor [1 ] =0 . 7 ; 
bbc . dif fuseColor [2  J =0.6; 

psbl. enabled  = FALSE; 
psb2. enabled  = FALSE; 
psb3. enabled  = FALSE; 
psb4. enabled  = FALSE; 
psb5. enabled  = FALSE; 
psb6. enabled  = FALSE; 

} 

function  custom_top_set (value) 

{ 

tbc . dif fuseColor [ 0 ] =1 . 0 ; 
tbc . di f fuseColor [ 1 ] =1 . 0 ; 
tbc .dif fuseColor [2 ] =0.0; 

pstl. enabled  = TRUE; 
pst2. enabled  = TRUE; 
pst3. enabled  = TRUE; 
pst4. enabled  = TRUE; 
pst5. enabled  = TRUE; 
pst6. enabled  = TRUE; 

) 

function  custom_base_set (value) 

{ 

bbc .dif fuseColor [ 0] =1 . 0 ; 
bbc . dif fuseColor [ 1] =1 . 0; 
bbc . dif fuseColor [2 ] =0 . 0 ; 

psbl. enabled  = TRUE; 
psb2. enabled  = TRUE; 
psb3. enabled  = TRUE; 
psb4. enabled  = TRUE; 
psb5. enabled  = TRUE; 
psb6. enabled  = TRUE; 

} 

function  connector_length (value) 

{ 

tlegsr . enabled  = value; 
blegsr . enabled  = value; 


# system  event  routing  mechanism 

ROUTE  TOP_PLATFORM. translation  TO  LEGS.xyz 

ROUTE  TOP_PLATFORM . rotation  TO  LEGS.rxyz 


ROUTE 

ROUTE 

ROUTE 

ROUTE 

ROUTE 

ROUTE 


B_LEG1 . translation_changed 
B_LEG2 . translation_changed 
B_LEG3 . translation_changed 
B_LEG4 . translation_changed 
B_LEG5 . translation_changed 
B_LEG6 . translation_changed 


TO  LEGS.bxyz 
TO  LEGS  . bxyz 
TO  LEGS.bxyz 
TO  LEGS . bxyz 
TO  LEGS . bxyz 
TO  LEGS . bxyz 


ROUTE  T_LEG1 . translation_changed  TO 
ROUTE  T_LEG2 . translation_changed  TO 
ROUTE  T_LEG3 . translation_changed  TO 
ROUTE  T_LEG4 . translation_changed  TO 
ROUTE  T_LEG5 . translation_changed  TO 
ROUTE  T_LEG6 . translation_changed  TO 


LEGS . txyz 
LEGS . txyz 
LEGS . txyz 
LEGS . txyz 
LEGS  . txyz 
LEGS . txyz 


ROUTE  TS_B1 . translation_changed  TO  B_LEG1 . translation 
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ROUTE 

ROUTE 

ROUTE 

ROUTE 

ROUTE 


TS_B2 . translation_changed  TO 
TS_B3 . translation_changed  TO 
TS_B4 . translation_changed  TO 
TS_B5 . translation_changed  TO 
TS_B6 . translation_changed  TO 


B_LEG2 . translation 
B_LEG3 . translation 
B_LEG4 . translation 
B_LEG5 . translation 
B_LEG6 . translation 


ROUTE 

ROUTE 

ROUTE 

ROUTE 

ROUTE 

ROUTE 


TS_T1 . translation_changed 
TS_T2 . translation_changed 
TS_T3 . translation_changed 
TS_T4 . translation_changed 
TS_T5 . translation_changed 
TS_T6 . translation_changed 


TO  T_LEG1 . translation 
TO  T_LEG2 . translation 
TO  T_LEG3 . translation 
TO  T_LEG4 . translation 
TO  T_LEG5 . translation 
TO  T_LEG6 . translation 


ROUTE  BLEG_SENSOR.translation_changed  TO  LEG_LEN_CHANGE . trin 
ROUTE  TLEG_SENSOR.translation_changed  TO  LEG_LEN_CHANGE2 . trin 


7.  RUN.HTML 

<html> 

<head> 

<meta  http-equiv="Content-Type“ 
content^" text/html ; charset=iso-8859-l " > 

<meta  name= "GENERATOR"  content= "Microsoft  Frontpage  Express  2.0"> 

<title>  Spatial  Platform  </title> 

</head> 

<body> 

<h4  align="center”><font  color="#008080"  size="6"  face="Tahoma"><b>Platform 
Analysis</b></  f ontx/h4> 

<div  align="center"xcenter> 

<table  border="0"> 

<tr> 

<tdxembed  src= " Platfonn\Platform.wri " align="baseline”  border="0" 
width="500"  height="  520"x/td> 

<td><applet  code=" Platform. Platform. class"  align="baseline" 
width="250"  height="520”  mayscriptx/appletx/td> 

</tr> 

</table> 

</center> 

< / body> 

</html> 


8.  QIDB.ASP 


<% 

Response .Expires=-1 

t ********************************************************** 

' connecting  to  the  database 

t********************************************************** 


Dim  Connect 

Set  Connect  = Server .CreateObject ( "ADODB. Connect ion” ) 
Connect. Open  "qi” 


I********************************************************** 

' read  the  platform  configuration  from  URL 
' ********************************************************** 
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topconfig  = Request (" top" ) 
baseconfig  = Request ( "base" ) 


I********************************************************** 

' replace  the  'x'  to  spaces 

* ********************************************************** 

topconf ig=Replace ( topconfig, "x" , " ” ) 
baseconf ig=Replace {baseconfig, "x" , " " ) 


■ ********************************************************** 

' read  a set  of  data  from  database 
' ********************************************************** 


Dim  qidb 

Set  qidb  = Server. CreateObj ect ( "ADODB.RecordSet" ) 

SQL  = "SELECT  * FROM  Qualityindex  " &_ 

"Where  TopConfig  = ' " & topconfig  & " ' AND"  &_ 

" Baseconfig  = '"  & baseconfig  & "'  AND  status  = 'DONE'" 

qidb. Open  SQL,  Connect 

If  Not  qidb. EOF  Then 

'**  if  there  is  a matching  record  set,  return  the  result 
Response .Write ( "FOUND"  & vbNewLine) 

Response .Write (cdbl (qidb( "maxdet ") ) & vbNewLine) 

Response .Write (cdbl (qidb( "maxx” ) ) & vbNewLine) 

Response .Write (cdbl (qidb( "maxy" ) ) & vbNewLine) 

Response. Write (cdbl (qidb( "maxz" ) ) & vbNewLine) 

Response .Write (cdbl (qidb ( "maxrx" ) ) & vbNewLine) 

Response .Write (cdbl (qidb ( "maxry" ) ) & vbNewLine) 

Response .Write (cdbl (qidb ( "maxrz ") ) & vbNewLine) 

Else 

'**  checking  any  other  search  program  is  running 
Dim  process 

Set  process  = Server .CreateObject ( "ADODB .Recordset " ) 

SQL=" SELECT  * FROM  Qualityindex  WHERE  status  = 'PROCESSING'" 
process. Open  SQL,  Connect 

if  process. EOF  Then 

'**  no  other  process  in  running  so  insert  the  config  data  to  the  database 
'**  and  call  the  search  program. 

SQL="INSERT  INTO  Qualityindex  VALUES  ('"  & topconfig  & baseconfig  &, 

& ", -1,0, 0,0, 0,0,0, 'PROCESSING' ) " 

Connec  t . Execute ( SQL ) 

Set  WshShell  = CreateObject { "WScript . Shell " ) 

WshShell .Run  "D:\JHL\QIDB\RELEASE\MAXDET.EXE" 

Response .Write (" PROCESSING"  & vbNewLine) 


Else 


'**  another  process  is  running  so  wait  till  it  finishes 
Response .Write ( "WAIT"  & vbNewLine) 

End  If 

process . Close 
End  If 
qidb. Close 
Connect . Close 
%> 
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9.  MaxDet.cpp 


#import  "C:\Program  Files\Coim\on  Files\System\ADO\insadol5.dll"  \ 
no_nainespace  rename  (”  EOF " , "EndOfFile") 

#include  <stdio.h> 

# include  <math.h> 

#include  <ole2.h> 

#include  <malloc.h> 
tinclude  <conio.h> 

♦include  "icrsint.h" 

♦define  PI  3.141592 


//  Function  Declartion. 

inline  void  TESTHR (HRESULT  x)  {if  FAILED(x)  _com_issue_error (x) ; } ; 
PrintProviderError (_ConnectionPtr  pConnection) ; 

PrintComError (_com_error  &e) ; 

searching_maxdet (char*  topconfig,  char*  baseconfig,  double  result[7]) 
update_database (void) ; 

get_jacobi an (double  p[12][3],  double  jmat[6][61); 
double  get_determinant (double  J[6][6]); 
double  search (double  p[12][3],  double  maxcoord[6] ) ; 

apply_xf (double  p[12][3),  double  x,  double  y,  double  z, 

double  rx,  double  ry,  double  rz,  double  c[12][3J); 
vec_mult (double  p[4],  double  m[4][4]); 

mat_mult (double  ml[4][4],  double  m2[4][4],  double  r[4][4]>; 
display_matrix (double  m[4] [4] ) ; 


void 

void 

int 

void 

void 


void 

void 

void 

void 


////////////////////////////////////////////////////////// 


// 


II 

II 

// 


II  Main  Function 

// 

////////////////////////////////////////////////////////// 
void  main (void) 

{ 

HRESULT  hr  = S_OK; 


} 


if (FAILED( : iCoInitialize (NULL) ) ; 
return; 

update_database ( ) ; 

; ;CoUninitialize ( ) ; 


////////////////////////////////////////////////////////// 
//  // 

II  Read  from  the  database  and  update  the  data  // 

//  // 

////////////////////////////////////////////////////////// 
void  update_dat abase ( ) 

{ 

double  result[7]; 
char  buffer[ll]; 
int  o)<; 


//  Define  ADO  object  pointers. 

II  Initialize  pointers  on  define. 

//  These  are  in  the  ADODB: : namespace. 

_RecordsetPtr  pRstQI  = NULL; 

//  Define  string  variables. 

_bstr_t  strCnn("Data  Source=qi ;User  Id= ; Password= ; " ) ; 

try 

{ 
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//  Open  recordset  with  names  from  QI  table. 

TESTHR (pRstQI . Create Instance ( uuidof (Recordset) ) ) ; 

pRstQI->CursorType  = adOpenKeyset; 
pRstQI->LockType  = adLockOptimistic; 
pRstQI->Open (" SELECT  * FROM  Qualityindex  " 

"WHERE  status  = ' PROCESSING strCnn, adOpenKeyset , adLockOptimistic, 
adCmdText ) ; 

//  Store  original  data. 

_bstr_t  strTopConfig  = pRstQI->Fields->GetItem( "topconfig" ) ~>Value; 
_bstr_t  strBaseConf ig  = pRstQI->Fields->GetItem( "baseconf ig" ) ->Value; 

_bstr_t  strMaxDet  = pRstQI->Fields->GetItem( "maxdet” ) ->Value; 

_bstr_t  strMaxX  = pRstQI->FieldS“>GetItem( "maxx" ) ->Value; 

_bstr_t  strMaxY  = pRstQI->Fields->GetItem( "maxy" ) ->Value; 

_bstr_t  strMaxZ  = pRstQI->Fields->GetItem( "maxz" ) ->Value; 

_bstr_t  strMaxRX  = pRstQI->Fields->GetItem( "maxrx" ) ->Value; 

_bstr_t  strMaxRY  = pRstQI->Fields->GetItem( "maxry" ) ->Value; 

_bstr_t  strMaxRZ  = pRstQI->Fields->GetItem( "maxrz " ) ->Value; 

_bstr_t  strStatus  = pRstQI->Fields->GetItem( "status" ) ->Value; 

ok  = searching_maxdet { (char* ) StrTopConfig,  (char* ) strBaseConf ig,  result) 

//Change  data  in  edit  buffer. 

_gcvt (result [0] , 10 , buf f er ) ; 

pRstQI->Fields->GetItem( "maxdet" ) ->Value  = (_bstr_t) (buffer); 

_gcvt (result [1] , 10,buf fer) ; 

pRstQI“>Fields->GetItem( "maxx” ) ->Value  = (_bstr_t) (buffer) ; 

_gcvt (result [2] , 10, buf fer) ; 

pRstQI->Fields->GetItem( "maxy" ) ->Value  = (_bstr_t) (buf fer) ; 

_gcvt (result [3 ] , 10 , buf fer) ; 

pRstQI->Fields->GetItem( "maxz " ) ->Value  = (_bstr_t) (buffer) ; 

_gcvt (result [4 ] , 10 , buffer) ; 

pRstQI->Fields->GetItem( "maxrx" ) ->Value  = (_bstr_t) (buffer) ; 

_gcvt (result [5] , 10 , buf f er ) ; 

pRstQI->Fields->GetItem( "maxry" ) ->Value  = (_bstr_t) (buffer) ; 

_gcvt (result [6] , 10, buf fer) ; 

pRstQI->Fields->GetItem( "maxrz" ) ->Value  = (_bstr_t) (buffer) ; 
pRstQI->Fields->GetItem( "status" ) ->Value  = (_bstr_t) ( "DONE" ) ; 

if  (ok==0)  pRstQI->Update ( ) ; 
else  pRstQI->CancelUpdate ( ) ; 

pRstQI->Close ( ) ; 

} 

catch (_com_error  &e) 

{ 

//  Notify  the  user  of  errors  if  any. 

//  Pass  a connection  pointer  accessed  from  the  Recordset. 

_variant_t  vtConnect  = pRstQI->GetActiveConnection ( ) ; 

//  GetActiveConnection  returns  connect  string  if  connection 
//  is  not  open,  else  returns  Connection  object, 
switch (vtConnect . vt ) 

{ 

case  VT_BSTR: 

PrintComError (e) ; 
break; 

case  VT_DISPATCH: 

PrintProviderError (vtConnect)  ; 
break; 
default : 

printf ( "Errors  occured."); 
break; 

} 

} 

} 


////////////////////////////////////////////////////////// 
//  // 
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//  PrintProviderError  Function  / / 

//  / / 
////////////////////////////////////////////////////////// 
void  PrintProviderError (_ConnectionPtr  pConnection) 

C 

//  Print  Provider  Errors  from  Connection  object. 

//  pErr  is  a record  object  in  the  Connection's  Error  collection. 
ErrorPtr  pErr  = NULL; 

if(  (pConnection->Errors->Count)  > 0) 

{ 

long  nCount  = pConnection->Errors->Count; 

//  Collection  ranges  from  0 to  nCount  -1. 
for (long  i = 0;  i < nCount;  i++) 

{ 

pErr  = pConnection->Errors->GetItem(i) ; 
print f ( 'Error  number:  %x\t%s\n",  pErr->Number , 

(LPCSTR)  pErr->Description) ; 

} 

} 

} 

//////////////////////////////////////// 

// 

//  PrintComError  Function 

// 

//////////////////////////////////////// 
void  PrintComError (_com_error  &e) 

{ 

_bstr_t  bstrSource (e . Source  0 ) ; 

_bstr_t  bstrDescription (e .Description ( ) ) ; 

//  Print  Com  errors, 
printf ( "ErrorXn" ) ; 

print f (" \tCode  = %081x\n",  e.Error()); 
printf {“ \tCode  meaning  = %s\n” , e .ErrorMessage ( ) ) ; 
printf (” \tSource  = %s\n",  (LPCSTR)  bstrSource); 
printf (" XtDescription  = %s\n" , (LPCSTR)  bstrDescription); 

} 

///////////////////////////////////// 

// 

//  DetJm  search  Function 

// 

///////////////////////////////////// 
int  searching_maxdet (char*  topconfig, 

{ 

double  p [ 12 ] [ 3 ] , maxcoord [ 6 ] ; 
int  i ; 

sscanf (topconfig, ”%lf%lf%lf%lf%lf%lf%lf%lf%lf%lf%lf%lf " , 

&p(0] [0] ,&p[0] [1] ,&p[l] [0] ,&p[l] [1] ,&p[21 [01 ,&p(2] [1] , 
&p[3][0]  ,Scp[3]  [1]  ,&p[41  [0]  ,&p[4)  [1]  ,&p[5][0)  ,Scp[5][l)  ) ; 

sscanf (baseconfig, "%lf%lf%lf%lf%lf%lf%lf%lf%lf%lf %lf %lf " , 

&p[6] [0] ,&p[6] [1] ,&p(7] [0] ,&p[7] [1] ,&p[8] [0] ,&p[81 [1] , 

&p[9]  [0]  ,&p[9][l]  ,&p[10]  [0]  ,&p[10]  [11  ,Scp[ll]  [0]  ,&p[ll]  [1]  ) ; 

for  (i=0;  i<6;  i++) 

[ 

p[il [01=p[il [01 /lOOOO.O; 
p[il [ll=p[il [11/10000.0; 
p[il [21=0.0; 

p[i+61 [01=p[i+61 [01/10000.0; 
p[i+61 [ll=p[i+61 [11/10000.0; 
p[i+61 [21=0.0; 

} 

result [0] =ceil ( search (p, maxcoord) *100)/100; 


///////////////////// 

// 

// 

// 

///////////////////// 
char*  baseconfig,  double  result[71) 


////////////////// 

// 

// 

// 

////////////////// 
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for(i=l;  i<=3;  i++)  resul t [ i ] =ceil (maxcoord [ i-1 ] *1000 ) /lOOO ; 
for(i=4;  i<=6;  i + +)  resul t [ i ] =ceil (maxcoord [ i-1 ] *10 )/ 10 ; 

return  0; 

} 


////////////////////////////////////////////////////////// 
//  // 

//  DetJm  search  sub  function  // 

//  // 

////////////////////////////////////////////////////////// 
double  search (double  p[12][3],  double  maxcoord[6]) 

{ 

double  jmat [6] [ 6 ) , det j , coords [12 ] [3 ] ; 
double  X, y, z , rx, ry, rz ; 

double  minv[61,  maxv[6],  tstep,  astep; 
double  maxdet; 
int  i,ld; 


maxdet=0 . 0 ; 


minv [ 0 ] 

= minvfl]  = -2; 

minv [2 

maxv [ 0 1 

= maxv [ 1 ] = 2 ; 

maxv [ 2 

tstep  = 

1; 

0.0; 

4; 


minv [ 3 ] = minv [ 4 ] 
maxv [ 3 ] = maxv [ 4 ] 
astep  = 90; 


minv [5]  = -180; 
maxv [ 5 ] = 180; 


ld=0; 


while (tstep>0 . 0001  &&  astep>0.01) 

{ 


ld++; 

print f ( "Loop 
rx=0 ; ry=0 ; 
for  (rx=minv[3]; 
for  (ry=minv[4]; 
for  ( x=minv[0]; 
for  ( y=minv[l]; 
for  ( z=minv[2] ; 
for  (rz=minv[51; 


tstep  : %f  astep 

rx<maxv[3];  rx+=astep) 
ry<maxv[4];  ry+=astep) 
x<=maxv[0] ; x+=tstep) 
y<=maxv[l] ; y+=tstep) 
z<=maxv[2] ; z+=tstep) 
rz<maxv[51;  rz+=astep) 


: %f\n\n",ld,  tstep, 

{ 

{ 

{ 

{ 

{ 

{ 


in  #%d 


apply_xf (p,x,y,z,rx,ry,rz, coords) ; 
get_jacobian (coords, jmat) ; 
detj  = fabs (get_determinant ( jmat) ) ; 
if  (detj>maxdet) 

{ 

maxdet=det j ; 

maxcoord) 0 1 =x;  maxcoord[l] =y;  maxcoord[2] =z; 
maxcoord [3 ] =rx;  maxcoord [4 ] =ry;  maxcoord[ 5) =rz ; 

) 


astep) ; 


)}))}) 

for(i=0;  i<3;  i++) 

{ 

minv [ i ] =maxcoord [ i ] -tstep; 
minv[i+3] =maxcoord[i+3] -astep; 
maxv[ i ] =maxcoord [ i] +tstep; 
maxv [ i+3 ) =maxcoord[ i+3 ] +astep; 

} 


print f ( 

"max  = 

%f\n" , 

, maxdet)  ; 

printf ( 

" xy  z : 

%f 

%f  %f \n" ,maxcoord[0] ,maxcoord[l] ,maxcoord(2] ) 

printf ( 

" rxyz  : 

%f 

%f  %f\n\n" , maxcoord [3 ] , maxcoord [4 ] , maxcoord [ 5 

tstep  = 

tstep 

/ 4; 

astep  = 

astep 

/ 4; 

if  (minv[2]<0) 

minv 

[2]=0; 
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return  maxdet ; 

) 


////////////////////////////////////////////////////////// 
//  // 

//  Apply  transformation  matrix  to  the  top  platform  II 
II  // 


void  apply_xf (double  p[12][3],  double  x,  double  y,  double  z, 

double  rx,  double  ry,  double  rz,  double  c[12][3]) 

{ 

rx=rx*PI/180; 

ry=ry*PI/180; 

rz=rz*PI/180; 


double  ptr [4 1 , mat (4 ] [4 ] , tmpa [4 ) [4 ] , tmpb [4 ] [4 ] ; 
double  mt[4] [4 ] = { {1 , 0 , 0 , x) , 

{0,1, 0,y), 

{0,0, l,z), 

{0,0,0,1}); 

double  mrx [4] (4 ]={{!,  0 , 0 ,0}, 

{0,  cos(rx),  -sin(rx),0), 

{0,  sin(rx),  cos(rx),0), 

{0,  0 , 0 ,1}}; 

double  mry [4 ] [4 ] = { { cos (ry) , 0 , sin (ry) , 0 } , 

{ 0,1,  0 ,0), 

{-sin(ry),  0,  cos(ry),0), 

{ 0,0,  0 ,1}}; 

double  mrz (4 ] (4 ] ={ {cos (rz) , -sin (rz) ,0,0), 
{sin(rz),  cos (rz) , 0, 0) , 

{0,0, 1,0}, 

{ 0 , 0 , 0 , 1 } } ; 

int  i , j ; 

mat_mul t (mt , mrx , tmpa ) ; 
mat_mult (tmpa, mry, tmpb) ; 
mat_mult ( tmpb, mrz , mat ) ; 

ptr [3 1 =1.0; 
for(i=0;  i<6;  i++) 

{ 

for ( j=0; j<3; j++)  ptr(j]=p[i] [j]; 

vec_mult (ptr,mat) ; 

for ( j=0 ; j<3 ; j++)  c [i ] [ j ] =ptr [ j ] ; 

) 


for(i=6;  i<12;  i++) 

for(j=0;  j<3;  j++)  c [ i ] [ j ] =p [ i ] [ j ] ; 


} 


//  // 

II  Matrix-Vector  Multiplication  (4x4)  (4x1)  // 

//  // 

////////////////////////////////////////////////////////// 
void  vec_mult (double  pf4J,  double  m[4][4]) 

{ 

int  i , j ; 

double  r(4],value; 

for(i=0;  1<4;  i++) 

{ 

value=0 . 0 ; 


for(j=0;  j<4;  j++) 

value+=m[i] [ j ) *p( j ] ; 
r [i ] =value; 

} 

for(i=0;  i<4;  i++)  p[i]=r[i]; 
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'll!! 

//  // 

//  MatriX'Matrix  Multiplication  (4x4)  // 

//  // 

////////////////////////////////////////////////////////// 
void  mat_mult (double  ml!4]!4),  double  m2(4][41,  double  r[4][4I) 
{ 


int  i,j,k; 
double  value; 


for(i=0;  i<4;  i++) 

for(j=0;  j<4;  j++) 

{ 

value=0. 0; 

for()c=0;  )c<4;  k+  + ) value+=rol  [ i 1 [k]  *m2  [k]  [ j ] ; 
t[i] ( j]=value; 

} 


////////////////////////////////////////////////////////// 
//  // 

//  Fonri  a Jacobian  matrix  // 

//  // 

////////////////////////////////////////////////////////// 
void  get_jacobian (double  p[12](3],  double  jmat[6][61) 

{ 

double  1; 


for 

{ 


(int  i=0;  i<6;  i++) 


1 = 


jinat(0]  [i] 
jmattU [il 
jmat [2J (il 
jmat[3] [i] 
jmat [4] [il 
jmat [51 [il 


sqrt( (p[il [01-p[i+6] (01)*(p(il [01-p[i+61 [01) 

+(p[il [ll-p[i+61 [11 )*(p[i] [l]-p[i+61[l] )+(p[il [2]-p[i+61 [21 1 
*(p[il[21-p[i+6H21)); 

(p[i!  [01-p[i+6]  [OD/l; 

(p[i!  (ll-pU+61  [1])/1; 

(p[i!  [21-p[i+6]  [2D/1; 

(p[i! [ll*p[i+6] (2]-p[il [21*p[i+6][ll>/l; 

(p[il  [2]»p[i  + 6]  (01-^p[il(01*p[i  + 6)[2]>/l; 

(p(il [01*p[i+6] [ll-plil (ll*p[i+61 [0])/l; 


//////////////////////////////;/;///////////////////////// 
//  // 

//  Calculate  determinant  of  J // 

//  // 

//////////////////////y//;/;////////////////////////////// 

double  get_determinant (double  J[61[61) 

{ 

double  ans=0; 
double  s[61,  D[5)[6]; 
int  i , j , k, 1 , m, n; 


s[01=0; 

for ( i=0; i<6; i++> 

[ 

s[ll=0; 

D[01 [i)=0; 

for ( j=0; j<6; j++ ) 

[ 

if(j==i)  continue: 
s[21=0; 

Dill [jl=0; 
for (k=0; k<6 ; k++ ) 

{ 

if (k==i I I k== j I continue; 
s[31=0; 
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D[2) [k]=0; 
for(l=0;l<6;l++) 

( 

if ( l==i I 1 1== j I I l==k)  continue; 
s[4]=0; 

D[3] [1]=0; 
for (m=0 ;m<6 ;m++ ) 

{ 

if(m=  = i|  |m=  = j I |ii\==kl  |m==l)  continue; 
s[5]=0; 

D[4] [m]=0; 
f or (n=0;n<6 ;n++ ) 

{ 

if (n==i I I n== j I | n==k | | n==l | | n==m)  continue 

D[4) [m]=pow(-l,s[5] )*J[5] [n] ; 

s[51++; 

} 

D[3] [l]+=pow(-l,s[4] ) *J[4] [m] *D[4] [m] ; 
s [4 ] ++ ; 

} 

D[2]  [k]+=pow(-l,s[3])*J[3]  [11*D[3J  [1]  ; 
s[3]++; 

} 

D[l] [j]+=pow(-l,s[2] )*J[2] [kl*D[2] [k] ; 
s[2]++; 

) 

D[01  [il+=pow(-l,s[l] )*J[1]  [j]*D[l]  [jl  ; 
s[l]++; 

} 

ans+=pow( -1 , s[0] )*J[0] [i] *D[0] [i] ; 
s[0]++; 

} 

return  ans; 

} 
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